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INTRODUCTION 


In many wind tunnels, the model support sting drive can both pitch and 
roll the sting support. In addition, some tunnels have articulated stings that are 
hinged between the sting drive mechanism and the model to pitch the model to 
higher angles. This allows tests to be made at higher angles of attack than those 
available with the regular sting drive. 

Determination of the angles necessary to set the sting drive mechanism 
and the articulated sting pitch angle is simple when only a given angle of attack 
is desired. However, if an angle of sideslip is desired, it can be very difficult to 
determine the sting angles necessary to give the desired or and (3 on the model. 

A program has been developed (ref. 1) to compute the pitch and roll of a 
conventional wind tunnel sting to position a model at the desired a and /3. 

This program accepts stings with offset angles in yaw, pitch, and roll. 

Also, an algorithm is described in reference 2 that uses matrix algebra to 
develop equations for the sting drive angles necessary to position a wind tunnel 
model in a wind tunnel. These equations can solve for three degree of freedom 
sting drive angles necessary to position the model at any attitude including the 
effects of sting offsets and sting bending angles. 

The programs in this report compute the pitch and roll position of the 
conventional sting drive and the pitch of the high angle articulated sting to 
position the model at the desired a and /3 and position the model as near as 


possible to the centerline of the tunnel. 


Two computer programs have been developed and are described in this 
report. These programs cover the case of no accelerometers on board the model 
and the case of accelerometers on board the model to measure model pitch 
and/or model roll with respect to gravity. 

These programs are iterative programs in that they calculate the a and 
0 position of the model in the tunnel based on assumed pitch and roll angles of 
the sting drive and the pitch of the articulated sting; and then calculate new 
positions for the sting pitch and roll and second or articulated pitch to move the 
model closer to the desired or and 0, and position the model in the center of 
the tunnel. This process is continued until the calculated a and /? of the model 
match the desired a and /3 within a small increment and the model is close as 
possible to the center of the tunnel. This procedure insures that the a and /3 
calculated by the data reduction program based on the available information 
such as stream flow angles, sting bending due to measured model forces, and on 
board measurements of model pitch and roll, if available, will match the desired 
a and /?. 

Both of these programs accept three sting offset angles, three sting 
bending angles, and two tunnel flow angles. In addition, the second program 
accepts on board measured pitch angle and on board measured roll angle, if 
available. 
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SYMBOLS 


u Velocity along X axis of model 

v Velocity along Y axis of model 

w Velocity along Z axis of model 

X Longitudinal body axis, positive aft, see figure 1 

Y Lateral body axis, positive to right, see figure 1 
Z Vertical body axis, positive upward, see figure 1 
a Model angle of attack, a = arctan (w/u), see figure 1 

0 Model angle of slideslip, 0 = arcsin (-v/V a ), see figure 1 

0 Model pitch angle, positive direction is nose up, see figure 1 
d Q ff Sting offset angle in pitch 

0 sb Sting bending in pitch 

0 Sting drive pitch command 
0 sc2 Articulated sting pitch command 

4> Model roll angle, positive direction is right wing down, see figure 1 

4> off Sting offset angle in roll 

4> sb Sting bending in roll 

^ Sting drive roll command 

^sc2 Articulated sting roll 

^ Model yaw angle, positive direction is nose right, see figure 1 


^off 

^sb 


Sting offset angle in yaw 
Sting bending in yaw 
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DETERMINATION OF ANGLE OF ATTACK AND 
ANGLE OF SIDESLIP FOR A WIND TUNNEL MODEL 

The definition of angle of attack, a, on a wind-tunnel model is given in 
reference 3 as the arctan (w/u) where w is the component of the free stream 
velocity along the Z axis of the model (vertical axis with the positive direction 
upward) and u is the component of the free stream velocity along the X axis of 
the model (longitudinal axis with the positive direction aft). This definition 
applies no matter what the orientation of the model is. By examining the signs 
of u and w, the correct quadrant for a can be determined between -180° and 
+ 180°. If both u and w are zero, then the angle of attack is indeterminate, 
but in these programs, when both u and w are equal to zero, a is defined to be 
equal to zero 

The angle of sideslip, 0, is defined in reference 3 as the arcsin 
(' v/V oo) where v is the component of the free stream velocity along the Y axis 
of the model (the lateral axis with the positive direction out the right or 
starboard wing) and V w is the total free stream velocity. This means that 0 
is positive when the flow is from the right. 

In these computer programs, the free stream velocity, V^, is set equal 
to one, and the components of the free stream velocity along the wind-tunnel 
axis system (u, v, and w) are calculated from the angles of upwash and 
sidewash in the wind tunnel. The upwash angle (UWA) is defined to be 
positive when the flow is upward in the tunnel (i.e., the w component is 
positive) and the sidewash to be positive when the flow is from the right to the 
left (from the starboard to the port). For positive wind-tunnel sidewash angle 
and the model pitch, roll and yaw angles equal to zero, the v component of the 
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model velocity is negative and the model sideslip angle, 0, is positive. 

The three velocities (u, v, and w) along with the three axes of the model 
are recalculated for each rotation of the model. By convention, the rotations are 
taken in order of yaw, pitch, and then roll (i.e., rotation about the Z axis, and 
Y axis, and then the X axis of the model). The equations for the u, v, and w 
velocities after rotation through each of the angles are given below. 

Yaw (rotation about Z axis), 

UA = U * cos(^) - V * sin(\^) 

VA = V * cos M + U * sin(^) 

WA = W 

Pitch (rotation about Y axis), 0 

UB = UA * cos(0) - WA * sin(0) 

VB = VA 

WB = WA * cos(0) + UA * sin(0) 

Roll (rotation about X axis), <f> 

UC = UB 

VC = VB * cos (<*>) - WB * sin(<*>) 

WC = WB * cos (<f>) + VB * sin(4>) 

Where \p is the angle of yaw (positive for nose right), 0 is the angle 
of pitch (positive for nose up), and <f> is the angle of roll (positive for right 
wing down). These angles are shown in figure 1 from reference 4. 

The equations given above are used in subroutine ALPBET of program 
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STNG2PR to calculate the velocities u, v, and w after each rotation of the 
model. After the three velocities are determined, the angle of attack, a, the 
angle of sideslip, /S, are calculated using the formulas given above. 

DESCRIPTION OF COMPUTER PROGRAMS 

Two computer programs were developed to calculate the sting pitch 
angie, 0 SC , sting roll angle, and the second sting pitch angle, 0^, 
necessary to obtain the desired a and 0 and to position the model as close as 
possible to the center line of the tunnel. Since this problem has three dependent 
variables (0 SC , 4> sc , and 0 sc2 ), it requires that three independent quantities 
be specified in order that the problem be completely defined. The variables 
chosen are the a and /3 of the model and the position of the model in the 
tunnel with respect to the centerline of the tunnel. When no restraints are given 
for the three dependent variables (0^, <^ sc , and 0^), the program will 
find a solution that gives the desired a and /3 and puts the model on the 
centerline of the tunnel. However, this solution may require sting pitch angles, 
^sc’ greater than or less than those obtainable from the tunnel sting pitch drive 
(see figure 2). In these cases, the program puts the sting at the limit of the sting 
drive and changes the other two variables and 0^) to position the 
model at the desired a and /? and as close as possible to the tunnel centerline. 

The first program, STNG2, calculates the sting pitch and roll and second 
sting pitch angles based on the sting geometry, such as sting offsets and sting 
bending. This program consists of the main program and three subroutines. A 
listing of the program is given in Appendix A. 

The second program, STNG2PR, calculates the sting pitch and roll and 
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second sting pitch angles from the sting geometry but also uses inputs from 
accelerometers on board the model that measure the model pitch and roll angles. 
This program consists of a main program and five subroutines and a listing is 
given in Appendix B. 

A list and description of the variables used in these programs is given 
after the description of the programs. 

PROGRAM STNG2 


Program STNG2 calculates the sting pitch, 6 sc , sting roll, ^> sc , and 
second sting pitch, 0 sc2 , necessary to obtain a desired model angle of attack, 
a, angle of sideslip, /3, and position the model in the center of the tunnel. 

The program actually first calculates the a, /S, and position of the model in the 
tunnel for an assumed sting pitch, sting roll, and second sting pitch. Then, by 
iteration, the assumed sting pitch, sting roll, and second sting pitch angles are 
changed until the calculated a and 0 agree with the desired or command or 
and /3 (ALPC and BETC) and the model is located on the centerline of the 
tunnel. 


Program STNG2 is very similar to program STNG reported in reference 
1. Program STNG2 has three factors, called FA, FB, and FD, which are equal 
to the change in alpha, beta, and distance from the centerline of the tunnel, 
respectively, with a unit change in the angle of sting (either pitch, 0 SC , roll 
4> & , or second pitch angle, 6^, depending on which angle is being 
optimized.) These factors are combined linearly with the error between the 
actual value of the angle or distance (ALP, BET, and DIS) and the desired angle 
or distance (ALPC, BETC, and zero distance) to give the function F. This 
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function is then minimized by subroutine CONV which uses a procedure which 
is equivalent to the secant method of finding the roots of an equation to find the 
sting position that reduces F to a minimum value. 

Each time subroutine CONV is called to find the sting position to 
minimize F, subroutine VEL is called to determine the a and /?, and 
subroutine DIS is called to determine the distance of the model from the 
centerline, at the new sting position. These new values for a, (3, and distance 
are then used to calculate a new value for F. This process is repeated until the 
absolute value of F is less than the tolerance for F (TOLF = 0.00001) or for a 
maximum of three iterations. 

The function F is calculated and minimized first for sting pitch 
(THESC), then for sting roll (PHISC), and then for the second sting pitch 
(THESC2). 

After the F has been minimized for each of the three sting angles, the 
entire procedure is repeated until the change in each of the three sting angles 
(THESC, PHISC, and THESC2) is less than the tolerance for sting angles 
(TOLANG = 0.01) in the last iteration or for a maximum of 100 iterations. 

The program usually reaches the limit for TOLANG in about 50 
iterations with the a and 0 within about 0.001 degrees of the desired angle 
and the distance equal to about 0.2 (where the units for distance are the same as 
used to specify the sting lengths, Rl, X2, and X3 at the beginning of the 
program). 

The program then checks to see if the sting roll position is outside the 
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limits set for the sting roll position at the beginning of the program (-85° to 
100° for model upright). 

If the sting roll is outside the limits, the program is rerun from statement 
50 with the pitch equal to negative of the pitch solution and the roll equal roll 
solution +. 180°. The solution with the new initial values for pitch and roll is 
very quick and the sting roll will be between the limits of -85° to 100°. If 
an inverted solution is desired, the limits on the sting roll can be changed to 
+80° for the lower limit (PHISLL) and 265° for the upper limit 
(PHISLU). 

The program then checks to see if the sting pitch (THESC) is within the 
limits for sting pitch available in the wind tunnel. The lower limit, THESLL, is 
set to -11° and the upper limit, THESLU, is set to +19° in this program. 

If the sting pitch command THESC is within the sting limits, the program 
continues on to the section of the program starting at the DO 2000 statement 
where the angle of attack, ALP, and the angle of sideslip, BET, are converged 
to the commanded angle of attack, ALPC, and the commanded angle of 
sideslip, BETC, without regard to the distance of the wind tunnel model from 
the centerline of the tunnel. In this section of the program, the factor F is a 
function of the error in angle of attack, DALP and angle of sideslip, DBET 
only. Therefore, 

F = FA "'DALP + FB*DBET 

As before, the function F is calculated and minimized first for the sting pitch 
(THESC), then for the sting roll (PHISC), and then for the second sting pitch 
(THESC2). This procedure is repeated until the error in angle of attack, 

DALP, and the error in angle of sideslip, DBET is reduced to less than the 
tolerance TOLDAB. (Set to 0.00001 at the beginning of the program). 
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If the sting pitch command, THESC, is outside the limits for sting pitch 
available in the wind tunnel, the sting pitch is set to the nearest limit and the 
program goes to statement 2020. In this part of the program as in the part after 
the DO 2000 statement, the program converges the angle of attack, ALP, and 
angle of sideslip, BET, to the commanded angles of attack and sideslip without 
regard to the distance from the wind tunnel model to the centerline of the 
tunnel. However, the sting pitch is fixed at the sting pitch limit and only the 
second sting pitch, THESC2, and the sting roll, PHISC, are used (in that order) 
to reduce the error in ALP and BET. 

There is a counter in the program (IREPT) which is used to stop 
execution if the program gets into an infinite loop when it returns to statement 
50 over and over. This can happen if the program is asked to solve an 
impossible case such as the BETC of 20° when the sting pitch limits are 
+ 19° and -11°. 

Since STNG2 converges much more slowly than the STNG program did 
(sometimes 65 iterations in STNG2 compared to generally 10 to 20 in STNG), 
the answers from the previous calculation are saved and used as a starting point 
for the next calculations in the STNG2 program. 

The answers for the first part of the program where THESC is unlimited 
are saved as the variables THESCUL, PHISCUL, and THES2UL. The answers 
of the last part of the program where THESC is limited are saved as the variable 
THESC2L and PHISCL. 
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The following is a list and description of the variables used in program 


STNG2 (all angles are degrees): 


ALP 

ALPC 

BET 

BETC 

DALP 

DBET 

DIS 


DY 

DZ 

F 

FA 

FB 

FD 

IREPT 

PHIOFF 

PHISB 

PHISC 


Angle of attack of model, a 
Command or desired angle of attack 
Angle of sideslip of model, /? 

Command or desired angle of sideslip 

Differences between angle of attack of the model and desired 

angle of attack 

Difference between angle of sideslip of the model and desired 
angle of sideslip 

Distance of the wind tunnel model from the centerline of the 
wind tunnel measured perpendicular to the wing span (with 

Ki = <n- 

Lateral distance of the wind tunnel model from the centerline 
(Positive to the right) 

Vertical distance of the wind tunnel model from the centerline 
(Positive upward) 

Function which is to be minimized by pitching and rolling the 

sting drive and pitching the high angle articulated sting 

Weighting factor for DALP in the function F 

Weighting factor for DBET in the function F 

Weighting factor for DIS in the function F 

Variable used to limit the number of times the program starts 

over after converging outside the sting roll limits 

Sting offset angle in roll (<£ off ) 

Sting bending in roll <£ sb ) 

Sting roll command (4^) required to position the model at the 


11 


PHISCL 

PHISCUL 

PHISC2 

PHISLL 

PHISLU 

PSIOFF 

PSISB 

R1 

SWA 

THEOFF 

THESB 

THESC 

THESCUL 

THESC2 

THESC2L 

THESLL 

THESLU 

THES2UL 

TOLANG 


desired a and /? and at the centerline of the tunnel 
Sting roll command with sting pitch fixed at the limit. Used as a 
starting point for the next computation after statement 2020 
Sting roll command with sting pitch unlimited. Used as a starting 
point for the next computation just above statement 50 
Second (articulated) sting offset in roll. Set to a constant value at 
the beginning of the program and not changed by the program. 
Lower limit on sting roll. 

Upper limit on sting roll. 

Sting offset angle in yaw (^ off ). 

Sting bending in yaw (^ sb ). 

Radius of the sting pitch arc sector (see figure 2). 

Wind tunnel free stream sidewash angle, positive for flow from 
right. 

Sting offset angle in pitch (0 off ). 

Sting bending angle in pitch (0 sb ). 

Sting pitch command (0^) required to position the model at the 
desired a and /3. 

Sting pitch command with sting pitch unlimited. Used as a 
starting point for the next computation just above statement 50. 
Second (articulated) sting pitch angle. 

Second sting pitch angle with sting pitch fixed at the limit. Used 
as a starting point for the next computation after statement 2020. 
Lower limit for sting pitch angle. 

Upper limit for sting pitch angle. 

Second sting pitch angle with sting pitch unlimited. Used as a 
starting point for the next computation just above statement 50. 
Convergence tolerance for the movement of the three sting angles 
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TOLDAB 


TOLF 

UWA 

u 

v 

w 

X2 

X3 


during the last iteration. 

Convergence tolerance for the sum of the absolute values of 
DALP and DBET. 

Convergence tolerance for the value of F. 

Wind tunnel free stream upwash angle, positive for flow from 
below. 

Free stream velocity component in the longitudinal direction in 
the wind tunnel (the total free stream velocity is assumed to be 
1 . 0 ). 

Free stream velocity component in the lateral direction (flow 
from the right when looking forward is positive). 

Free stream velocity component in the vertical direction (upward 
flow is positive). 

Distance from sting pitch arc sector to second (articulated) sting 
pitch axis. (See figure 2.) 

Distance from second sting pitch axis to wind tunnel model. (See 
figure 2.) 
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SUBROUTINE VEL 


The purpose of subroutine VEL is to calculate the angle of attack, a, 
and angle of sideslip, 0, of the wind tunnel model. The subroutine requires 
inputs of the velocity components in the wind tunnel u, v, and w; the sting 
offset angles; the sting bending angles; and the sting drive angles. The 
subroutine calculates the components of the free stream velocity along the three 
axes of the model after each rotation angle using the formulas given in the 
section "Determination of Angle of Attack and Angle of Sideslip for a Wind 
Tunnel Model." After the last rotation, these velocities are used to calculate the 
angle of attack, a, and angle of sideslip, /?, using the following formulas: 

a = arctan (w/u) 

j3 = arcsin (-v/V w ) 

is set equal to one in the main program (STNG2) and therefore: 

0 = arcsin (-v) 

The following is a list and description of the additional variables used in 
subroutine VEL: 

UB, . . . ,UI Longitudinal velocity in the model axis system after each 
rotation. 

VB, ... ,VI Lateral velocity in the model axis system after each rotation. 

WB, ... ,WI Vertical velocity in the model axis system after each rotation. 
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SUBROUTINE DISTANCE 


Subroutine distance calculates the position of the wind tunnel model 
relative to the centerline of the wind tunnel. The subroutine requires inputs of 
the lengths of the various portions of the sting, Rl, X2, and X3; the sting offset 
angles in yaw (PSIOFF), pitch (THEOFF) and roll (PSIOFF); and the sting 
drive angles, THESC, PHISC, and THESC2. The distance DY and DZ are 
calculated by subroutine DIST where DY is the lateral distance of the model 
from the wind tunnel centerline with positive direction to the right and DZ is the 
vertical distance from the centerline with positive values above the centerline. 
The units of the distances DY and DZ are the same as the units used to input the 
values of Rl, X2, and X3. 

The program starts with an axis system aligned to the model axis system 
and then translates and rotates the axis system along the stings until it is aligned 
to the wind tunnel axis system. As each of these translations and rotations are 
made, the subroutine calculates the position of the model in the axis system after 
each movement. Since the translations and rotations are taken in reverse order 
(normally the program calculates the effect of sting pitch first, and second sting 
roll last, (i.e., see subroutine VEL). The angles used in subroutine DIST are 
the negative of the angles used in the normal procedure. 


15 


The following is a list and description of the additional variables used in 
subroutine DIST: 

XA, XJ Longitudinal distance of the wind tunnel model in the translated 
and/or rotated axis system (positive downstream). 

YA, YJ Lateral distance of the wind tunnel model in the translated and/or 
rotated axis system (positive to the right facing upstream). 

XA, ...» ZJ Vertical distance of the wind tunnel model in the translated 
and/or rotated axis system (positive upward). 

SUBROUTINE CONV 

The purpose of subroutine CONV is to minimize a function Y = F(X). 
The function is calculated in the calling program and the subroutine calculates a 
new value of the independent variable X that will make the value of the 
dependent variable Y , nearer to zero. The new value of X is determined by 
calculating where a straight line through the last two previous pairs of points; X 
and Y, and XSAVE and YSAVE; intersects the X axis. 
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This new value is returned to the calling program in the X parameter and 
the old X and Y are placed in the XSAVE and YSAVE parameters at the end of 
the subroutine. In order to improve the stability of this procedure, certain limits 
are placed on the distance the new X value can be from the old X and XSAVE 
values. The IF statement above statement 3 of the subroutine CONV limits the 
new X value to be no more than 3.5 times the distance between the old X and 
XSAVE values away from the average of these values. Also if the two previous 
values for X are the same, the new X is calculated in a special way in statement 
3. If the two previous Y values are the same, the new X is calculated to be the 
average of the two previous X's in statement 4. 


The following is a list and description of the variables used in subroutine 
CONV: 


DX 

X 

XA 

XK 

XSAVE 

XI 
X2 
Y 

YSAVE 

Y1 

Y2 


Absolute distance between XI and X2. 

Latest value of the independent variable. Also returned as the 
next value to be tried for the independent variable. 

Average of XI and X2. 

Slope of line between XI, Y1 and X2, Y2. 

Previous value of independent variable. Also returned as 
previous value of X. 

Previous value of the independent variable (same as XSAVE). 
Latest value of the independent variable. 

Latest value of the dependent variable. 

Previous value of the dependent variable. Also returned as the 
previous value of Y. 

Previous value of the dependent variable (same as YSAVE). 
Latest value of the dependent variable. 
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PROGRAM STNG2PR 


Program STNG2PR calculates the sting pitch and roll angles and 
articulated sting pitch angle required to obtain the desired angle of attack and 
angle of sideslip and position the model near the centerline of the wind tunnel 
when the model has on board measurements of the model pitch and roll (or 
pitch only if the roll is not available). The model pitch and roll is assumed to 
be measured relative to gravity. 

At first it would appear that these cases would simplify the calculation of 
the alpha and beta of the model in the wind tunnel since the effects of sting 
offsets and sting bending are already included in the on board measurements of 
model pitch and roll. This is true in the case where a straight sting is used and 
the model yaw is assumed to equal zero. Since most wind tunnel tests use 
straight stings, on board measurements of model pitch and roll is a very 
valuable method of determining model alpha and beta in the wind tunnel. For 
bent stings, however, model yaw cannot be assumed to equal zero and model 
pitch and roll alone is not sufficient to determine model angle of attack and 
angle of sideslip. 

In order to make program STNG2PR more generally applicable, no 
assumptions were made about the sting offset angles or the model yaw angle in 
the wind tunnel. Therefore, the program is applicable not only to the case of 
straight sting, but also to the case where the sting is offset and/or where sting 
bending occurs. 

Program STNG2PR is similar to program STNG2 in that they both 
calculate the model a, (3, and position of the model in the tunnel at a given 
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sting position and then, by the use of a factor, try to reduce the difference 
between the calculated a and /3 and the desired or commanded a and |3 and 
position the model near the centerline of the wind tunnel. 

Program STNG2PR uses the same function (F) as program STNG2 uses 
to reduce the error between the calculated a and 0 and the desired a and 0 
and to position the model near the centerline of the wind tunnel. The major 
difference between the two programs is that STNG2PR uses a three-step process 
to calculate a and 0 instead of the one step that STNG uses (subroutine VEL). 
The three steps are: first, calculate the yaw, pitch and roll angles of the model 
from the sting support system angles and the sting geometry (subroutine 
SIMUST), second, correct the pitch and roll of the model by the difference 
between the measured model pitch and roll, and the calculated model pitch and 
roll (DTHEMOB and DPHIMOB) determined at the beginning of the program; 
and third, calculate the a and 0 of the model from the model yaw, pitch and 
roll angles (subroutine ALPBET). 

When programs STNG2 and STNG2PR are used in actual wind tunnel 
situations, the sting drive angles calculated by these programs will change 
somewhat as the sting and model move to the commanded positions because the 
sting bending angles will change as the angles of attack and sideslip of the 
model change, and because the differences between the calculated model pitch 
and roll and the on board measured model pitch and roll change as the model 
attitude changes. The final position, however, will be the correct position to 
obtain the desired a and /3, since the final values for the sting bending and 
measured model pitch and roll will be the same as those used by the wind tunnel 
data reduction program. 
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The following is a list and description of the additional variables used in 
program STNG2PR (all angles are in degrees): 


DPHIMOB 

DTHEMOB 

PHIMOB 

PHIMOBT 

PHIMT 


PHIS 

PHIS2 

PSIMT 


THEMOB 

THEMOBT 

THEMT 


THES 

THES2 


Difference between PHIMOB and PHIMT determined at 
the beginning of the program. 

Difference between THEMOB and THEMT determined at 
the beginning of the program. 

Roll and model as measured by on board accelerometers. 
Theoretical on board roll of model. 

PHIMOBT = PHIMT + DPHIMOB 
Theoretical roll of model as determined by subroutine 
SIMUST from the sting drive angles, sting offset angles, 
and sting bending angles. 

Actual sting drive roll angle. 

Actual articulated sting pitch angle. 

Theoretical yaw angle of the model as determined by 
subroutine SIMUST from the sting drive angles, sting 
offset angles, and sting bending angles. 

Pitch of model as measured by on board accelerometers. 
Theoretical on board pitch of model. 

THEMOBT = THEMT + DTHEMOB 
Theoretical pitch of model as determined by subroutine 
SIMUST from the sting drive angles, sting offset angles 
and sting bending angles. 

Actual sting drive pitch angle. 

Actual articulated sting pitch angle. 
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SUBROUTINE SIMUST 


Subroutine SIMUST simulates the sting-support, sting, and model 
system mathematically to calculate the model yaw, pitch and roll angles from 
the sting drive, sting offset and sting bending angles. The method of calculating 
the model yaw, pitch and roll is discussed in reference 4 and 5, and is explained 
below. 


The pitch angle of the model is determined by calculating the X 
component, in the model axis system, of a unit vector in the Z direction of the 
tunnel axis system (XZ). The pitch angle is then the arcsin (-XZ). The pitch 
angle can range from -90° to +90°. 

The roll of the model is determined by calculating the Y and Z 
components, in the model axis system, of a unit vector in the Z direction of the 
tunnel axis system (YZ and ZZ). The roll of the model is then the arctan 
(-YZ/ZZ) where the quadrant of the roll angle is determined by the sings of YZ 
and ZZ individually. The roll angle can range from -180° to 180°. If 
both YZ and ZZ are zero (i.e. , the pitch angle is +90°) then the roll of the 
model is determined by the arctan (-YX, ZX) and the yaw of the model is 
defined to be equal to zero (where YX and ZX are the Y component and the Z 
component respectively of a unit vector in the X direction of the tunnel axis 
system). 

The yaw of the model is determined by calculating the X component in 
the model axis system of a unit Y vector in the wind tunnel axis system, XY, 
and the X component in the model axis system of a unit X vector in the tunnel 
axis system, XX. The yaw of the model is then the arctan (-XY/XX) and can 
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range from -180° to 180°. 


The following is a list and description of the additional variables used in 


subroutine SIMUST: 


PHIS 

Sting drive roll angle. 

PHIS2 

Second sting roll angle. 

THES 

Sting drive pitch angle. 

THES2 

Second sting drive pitch angle. 

XX, YX, ZX 

The X, Y, and Z components in the model axis system of 
a unit vector in the X direction in the tunnel axis system. 

XY, YY, ZY 

The X, Y, and Z components in the model axis system of 
a unit vector in the Y direction in the tunnel axis system. 

XZ, YZ, ZZ 

The X, Y, and Z components in the model axis system of 
a unit vector in the Z direction in the tunnel axis system. 


SUBROUTINE COMP 


Subroutine COMP is used to calculate the components, in the model axis 
system, of a unit vector in the wind tunnel axis system so that the model yaw, 
pitch and roll angles can be determined. This subroutine is very similar to 
subroutine VEL in program STNG2 which was used to calculate the velocity 
components in the model body axis system. Although this subroutine can 
calculate the X, Y, and Z components, in the model axis system, of an arbitrary 
vector in the wind tunnel axis system, it is only used in this program to 
calculate the components of a unit vector in the X, Y, or Z direction in the wind 
tunnel axis system. This means that one of the components, X, Y, or Z, is set 
equal to one and the other components are set equal to zero in the calling 
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program argument list. The components in the model body axis system of the 
unit vectors are then used in subroutine SIMUST to calculate the model yaw, 
pitch, and roll. 

The following is a list and description of the additional variables used in 


subroutine COMP: 


X, Y, Z 

X, Y, and Z components of a vector in the tunnel 
axis system. 

XB,...,XI 

X component in the model axis system of a vector 
in the tunnel axis system after each rotation. 

YB,...,YI 

Y component in the model axis system of a vector 
in the tunnel axis system after each rotation. 

ZB,...,ZI 

Z component in the model axis system of a vector 
in tunnel axis system after each rotation. 


SUBROUTINE ALPBET 

The purpose of subroutine ALPBET is to calculate the angle of attack, 
a, and angle of sideslip, /S, of the wind tunnel model. The subroutine 
requires inputs of the velocity components in the wind tunnel, U, V, and W, 
and the model Euler angles, yaw (ip), pitch (0), and roll (<t>). The 
subroutine calculates the components of the free stream velocity along the three 
axes of the model after each rotation angle using the formulas given in the 
section "Determination of Angle of Attack and Angle of Sideslip for a Wind 
Tunnel Model." After rotation through the three Euler angles, the velocities are 
used to calculate the angle of attack, a, and angle of sideslip, 0, using the 
following formulas: 
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a = arctan (v/u) 


i8 = arcsin (-v/V w ) 

V* is set to one in the main program (STNG2PR) and therefore: 

j3 = arcsin (-v) 

The following is a list and description of the additional variables used in 


subroutine ALPBET 

(all angles are in degrees): 

ALP 

Angle of attack of model, a. 

BET 

Angle of sideslip of model, /?. 

PHIM 

Angle of roll of model, <t>. 

PSIM 

Angle of yaw of model, \p. 

THEM 

Angle of pitch of model, 0. 

UA, UB, UC 

Longitudinal velocity component in the model axis system 
after each Euler angle rotation. 

VA, VB, VC 

Lateral velocity component in the model axis system after 
each Euler angle rotation. 

WA, WB, WC 

Vertical velocity component in the model axis system 
after each Euler angle rotation. 
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CONCLUDING REMARKS 


Two programs have been developed to calculate the pitch, roll, and 
second articulated pitch angles of a wind tunnel sting drive system that will 
position a model near the centerline and at the desired angle of attack and angle 
of sideslip in the wind tunnel. These programs account for the effects of sting 
offset angles, sting bending angles and wind tunnel stream flow angles. In 
addition, the second program incorporates inputs from on board accelerometers 
that measure model pitch and roll with respect to gravity. 

These program solve for the desired sting pitch and roll with an 
interactive procedure using the forward equations that calculate the model 
position, a and /? from the sting geometry and the sting pitch and roll. This 
procedure allows sting offset angles, sting bending angles, and stream flow 
angles to be taken into account. 

A copy of the source code of these two programs can be obtained from 
the Langley Computer Center with the following statements: 

GET, ZSTNG2/UN = 003 101 N 
or GET, ZTNG2PR/UN = 003101N 
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The run times for these programs very depending upon the number of 
iterations required to converge to a solution. The programs were compiled and 
run under Fortran 5 (Fortran 77) on the Control Data Corporation Cyber 
CY 180-860 computer at Langley Research Center. The run times for STNG2 
are from 0.065 seconds for one iteration to 36.4 seconds for 100 iterations and 
6 restarted calculations (the maximum allowed in these programs). 

Normally, however, run time for STNG2 vary from about 1.8 seconds 
for large changes in a and /3 from the previous computation to 0.38 second 
for small changes in a and 0 (i.e., 2°). Very small changes (i.e., 0.01°) 
require only two iterations and 0. 1 second run time. 

Run times for STNG2PR are about twice as long as the run times for 
STNG2. 
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APPENDIX A 


COMPUTER LISTING OF PROGRAM STNG2 


This appendix contains a computer listing of the program STNG2 which 
calculates the wind tunnel sting pitch and roll angles and second sting pitch angle 
required to obtain a desired angle of attack, a, and sideslip, 0, on a wind tunnel 
model and to position the model in the center of the tunnel. The program accepts 
inputs of stream flow angles in two directions and sting offsets and sting bending angles 
in three directions 
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1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 


PROGRAM STNG2 (INPUT, OUTPUT) 

C THIS PROGRAM CALCULATES THE STING ANGLES FOR THE HIGH ALPHA STING SYSTEM 
C TO GET THE DESIRED ALPHA AND BETA AND THE MINIMUM DISTANCE FROM THE 
C CENTERLINE OF THE TUNNEL ( ONLY THE SECOND PITCH ANGLE IS USED, NOT 
C THE SECOND ROLL ANGLE) 

C 

C ANSWERS SAVED FOR NEXT COMPUTATION 
C 

C THE ORDER OF ROTATIONS ARE : STING PITCH (THESC), STING ROLL (PKISC), 

C OFFSET YAW (PSIOFF), OFFSET PITCH (THEOFF), OFFSET ROLL (PHIOFF), 

C SECOND STING PITCH (THESC2) , SECOND STING ROLL (PHISC2) , 

C BENDING IN YAW (PSISB), BENDING IN PITCH (THES3), AND BENDING IN ROLL (PHISI 
G 

C CODED BY -- JOHN B. PETERSON, JR. NASA/LARC/AAD/HRNAB 1990 
C 

C STING OFFSETS 

PSIOFF=0. 

THEOFF=-20. 

PHIOFF=0 . 

PHISC2=0. 

C STING LENGTHS (SHOULD BE ON THE ORDER OF 57.3 UNITS SO THAT 

C DISTANCES AND ANGLES ARE OF SAME ORDER OF MAGNITUDE) 

C R1 IS THE RADIUS OF ROTATION OF THE ARC SECTOR. 

C X2 IS THE LENGTH OF THE MAIN STING. 

C X3 IS THE LENGTH CF THE SECOND (ARTICULATED) STING. 

C 

Rl=122 . 5 
X2=87 . 5 
X3=48 . 918 

C LIMITS 

C LIMITS ON STING ROLL ANGLE 

PHISLL=-85. 
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37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 
61 
62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 


PHISLU=100. 

C FOR INVERTED RUNS USE FOLLOWING LIMITS 
C PHISLL=80. 

C PHISLU=265 . 

C LIMITS ON STING PITCH ANGLE (THESE LIMITS ALSO LIMIT 

C THE AVAILABLE BETA TO +19 & -11 UPRIGHT AND -19 6c +11 INVERTED) 

THESLL=- 11 . 

THESLU=19 . 

C STREAM FLOW ANGLES 

C POSITIVE FOR FLOW FROM BELOW AND FROM RIGHT 

SWA= . 0 
UWA=. 0 

C FREE STREAM VELOCITIES (TOTAL VEL. = 1.0) 

U=SQRT( 1./ ( 1 . +(TAND(SWA) )**2+(TAND(UVA) )**2 ) ) 

V=-U*TAND(SWA) 

W= U*TAND(UWA) 

C SET INITIAL VALUES FOR VARIABLES 

THESCUL=0. 0 
PHISCUL=0. 0 
THES2UL=20. 

Ph'ISCL=0. 0 
THESC2L=20. 

THESSAV=999. 

PHISSAV=999 . 

THES2SV-999. 

C TOLERANCES 

TOLF=. 00001 
TOLDAB=. 00001 
TOLANG=. 01 
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75 

C 

INPUTS TO CONTROL PROGRAM 

76 



77 

C 

COMMAND ANGLES 

78 


ALPC=40 . 

79 


BETC=10. 

80 



81 

C 

STING DEFLECTIONS 

82 


PSISB=0. 0 

83 


THESB=0. 0 

84 


PHISB=0. 0 

85 



86 

C 

END OF INPUTS TO CONTROL PROGRAM 

87 



88 

c 

SET TO PREVIOUS ANSWERS UNLIMITED IN THESC 

89 


THESC = THESCUL 

90 


PHISC = PHISCUL 

91 


THESC2 = THES2UL 

92 



93 

c 

SET REPEAT COUNTER TO 0 

94 


IREPT = 0 

95 



96 


50 CONTINUE 

97 



98 


IREPT = IREPT + 1 

99 



100 


PRINT 98 

101 


PRINT 96 

102 


PRINT 99, THESC, PHISC, THESC2,PHISC2,ALPC,BETC,PSI0FF,THE0FF, 

103 


* PHIOFF 

104 

105 

c 

CONVERGE ON ALPHA COMMAND (ALPC), BETA COMMAND (BETC) 

106 

c 

AND DISTANCE (DIS) 

107 



108 


DO 1000 IC0NV=1, 100 

109 



110 


THESCSV=THESC-1. 

111 


CALL VEL (U,V,W,PSIOFF,THEOFF, PHIOFF, PSISB,THESB,PKISB, 

112 


* THESCSV, PHISC, THESC2,PHISC2, ALPSV,BETSV) 
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113 

114 

115 

116 

117 

118 

119 

120 
121 
122 

123 

124 

125 

126 

127 

128 

129 

130 

131 

132 

133 

134 

135 

136 

137 

138 

139 

140 

141 

142 

143 

144 

145 

146 

147 

148 

149 

150 


CALL DIST(R1 , X2,X3, PSIOFF , THE OFF, PHIOFF, THESCSV, PHISC .TEES C2 
* DYSV.DZSV) * 

DALPSV=ALPSV-ALPC 
DBETSV=BETSV-BETC 


DISSV = DZSV*COSD(PHISC) + DYSV*SIND(PHISC) 

CALL VEL (U,V,W, PSIOFF, THEOFF, PHIOFF, PSIS3,THESB,PHIS3, 

* THESC , PHISC, THESC2, PHISC2, ALP , BET ) 

CALL DIST(R1 ,X2 ,X3 , PSIOFF, THEOFF, PHIOFF, THESC , PHISC. THESC2 

* DY ,DZ ) ’ 

DALP =ALP - ALPC 

DBET =BET - BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

FA=ALP - ALPSV 
FB=3ET - BETSV 
FD=DIS - DISSV 


FSV = FA*D ALPSV + FB*DBETSV + FD*DISSV 
F = FA*DALP + FB*D3ET + FD*DIS 
DO 100 ICTHE=1 , 3 
CALL CONV( THESC .F.THESCSV.FSV) 

CALL VEL (U,V,W, PSIOFF, THEOFF, PHIOFF, PSISB,THESB, PHISB 

* THESC , PHISC,THESC2,PHISC2,ALP ,BET ) 

CALL DIST(R1,X2,X3, PSIOFF, THEOFF, PHIOFF, THESC , PHISC. THESC2 

* DY ,DZ ) 

DALP =ALP - ALPC 

DBET =BET - BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

F = FA*DALP + FB*DBET + FD*DIS 
IF(ABS(F) . LT.TOLF) GO TO 110 
100 CONTINUE 
110 CONTINUE 

IF (THESC .EQ. 0.) THESC=. 000001 
PHISCSV=?HISC-1. 

CALL VEL (U, V,W, PS IOFF, THEOFF, PHIOFF, PSISBjTHESB, PHI SB 

* THESC, PHISCSV,THESC2,PHISC2, ALPSV, BETSV) 

CALL DIST(R1,X2,X3, PSIOFF, THEOFF, PHIOFF, THESC, PHISCSV.THESC2 

* DYSV, DZSV) 

DALPSV=ALPSV-ALPC 

DBETSV-BETSV-BETC 


32 


151 

152 

153 

154 

155 

156 

157 

158 

159 

160 
161 
162 

163 

164 

165 

166 

167 

168 

169 

170 

171 

172 

173 

174 

175 

176 

177 

178 

179 

180 
181 
182 

183 

184 

185 

186 

187 

188 


DISSV = DZSV*COSD(PHISCSV) + DYSV*SIND(PHISCSV) 

CALL VEL (U,V,W, PS I0FF,THE0FF, PHIOFF, PSISB,THESB, PHISB, 

* THESC, PHISC ,THESC2 ,PHISC2, ALP , BET ) 

CALL DIST(R1,X2,X3, PSI0FF,THE0FF, PHIOFF, THESC, PHISC .TKESC2, 

* DY , DZ ) 

DAL?=ALP-ALPC 

DBET=BET-SETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

FA=ALP -ALPS' 

FB=BET-BETSV 
FD=DIS - DISSV 

FSV = FA*DALPSV + FS--DBETSV + FD*DISSV 
F = FA*DALP + FB*DBET + FD*DIS 
DO 200 ICPHI=1, 3 
CALL CONV(PHISC,F, PHISCSV,FSV) 

CALL VEL (U, V, V, PSIOFF,THEOFF,PHIOFF, PSISB,THESB, PHISB , 

* THESC, PHISC ,TKESC2, PHISC2, ALP , BET ) 

CALL DIST(R1,X2,X3, PS IOFFjTKEOFF, PHIOFF, THESC, PHI SC ,TKESC2, 

* DY ,DZ ) 

DALP=ALP-ALPC 

DBET=BET-BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

F = FA*DALP + FB*DBET + FD*DIS 
IF(ABS(F) . LT.TOLF) GO TO 210 
200 CONTINUE 
210 CONTINUE 

THESC2S=THESC2- 1 

CALL VEL (U, V,W, PS IOFFjTKEOFF, PHIOFF, PSISB.THESB, PHI S3, 

* THESC , PHI SC , THESC2S , PHISC2 , ALPSV, BETSV) 

CALL DIST(R1,X2 ,X3, PSIOFFjTHEOFF, PHIOFF, THESC, PHI SC, THESC2S, 

* DYSV,DZSV) 

DALPSV=ALPSV-ALPC 

DBETSV=BETSV-BETC 

DISSV = DZSV*COSD( PHI SC ) + DYSV*SIND(PHISC) 

CALL VEL (U,V,W,PSIOFF,THEOFF, PHIOFF, PSISB,THESB, PHISB, 

* THESC, PHI SC, THESC2 ,PHISC2,ALP , BET ) 

CALL DIST(R1,X2,X3,PSI0FF,THE0FF, PHIOFF, THESC, PHISC, THESC2 , 

* DY , DZ ) 
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189 

190 

191 

192 

193 

194 

195 

196 

197 

198 

199 

200 
201 
202 

203 

204 

205 

206 

207 

208 

209 

210 
211 
212 

213 

214 

215 

216 

217 

218 

219 

220 
221 
222 

223 

224 

225 

226 


DALP=ALP-ALPC 

DBET=BET-BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

FA=ALP -ALPSV 
FB=BET -BETSV 
FD=DIS - DISSV 

FSV = FA*DALPSV + FB*DBETSV + FD*DISSV 
F = FA*DALP + FB*DBET + FD*DIS 
DO 300 ICTHE2=1, 3 
CALL CONV(THESC2,F,THESC2S,FSV) 

CALL VEL (U, V,W, PSIOFF,THEOFF, PHIOFF, PSISB,THES3, PHISB, 

* THESC, PHI SC, THESC2 ,PHISC2,AL? ,BET ) 

CALL DIST(R1,X2, X3, PSIOFF, THEOFF, PHIOFF, THESC, PHISC , TKESC2 , 

* DY ,DZ ) 

DALP=ALP-ALPC 

DBET=BET-BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

F = FA*DALP + FB*D3ET + FD*DIS 
IF(ABS(F) . LT.TOLF) GO TO 310 
300 CONTINUE 
310 CONTINUE 

C CHECK TO SEE IF MOVEMENT IN THESC, PHISC AND THESC2 IS LESS THAN 

C TOLANG IN LAST ITERATION 

IF ( ABS(THESC-THESSAV) . LT. TOLANG 

* . AND. ABS( PHISC -PHI SSAV) . LT. TOLANG 

* . AND. ABS(THESC2-THES2SV).LT. TOLANG) GO TO 1010 
THESSAV=THESC 

PHISSAV=PHISC 
THSS2SV=THESC2 
1000 CONTINUE 
1010 CONTINUE 

PRINT 97, ICONV 
PRINT 94 

PRINT 99, THESC, PHISC, THESC2, PHISC2,ALP, BET,DY,DZ 
IF (IREPT.GE. 12) GO TO 3020 
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227 

228 

229 

230 

231 

232 

233 

234 

235 

236 

237 

238 

239 

240 

241 

242 

243 

244 

245 

246 

247 

248 

249 

250 

251 

252 

253 

254 

255 

256 

257 

258 

259 

260 
261 
262 

263 

264 


C CHECK TO SEE IF CONVERGED OUTSIDE PHIS LIMIT 

IF(PHISC.GT.PHISLU) THEN 
PHI SC=PHI SC - 180 . 

THESC=-THESC 
GO TO 50 
END IF 

IF(PHISC.LT. PHI SLL) THEN 
PHISC=PHISC+180. 

THESC=-THESC 
GO TO 50 
END IF 

C SAVE ANSWERS UNLIMITED IN PITCH FOR NEXT COMPUTATION 

THESCUL=THESC 
PHISCUL=PHISC 
THES2UL=THESC2 

C CHECK TO SEE IF THESC CONVERGED OUTSIDE THESC LIMIT 

IF (THESC. LT.THESLL) THEN 
THESC=TKESLL 
GO TO 2020 
END IF 

IF (THESC. GT.THESLU) THEN 
THESC=TKESLU 
GO TO 2020 
END IF 

PRINT 98 
PRINT 96 

PRINT 99 , THESC , PHISC , THESC2 , PHISC2 , ALPC, BETC, PSIOFFjTHEOFF, 

* PHI OFF 

C FINAL CONVERGENCE ON ALPHA COMMAND (ALPC) AND BETA COMMAND (3ETC) 

C WITHOUT REGARD TO DISTANCE (DIS) 

DO 2000 IC0NV=1, 100 
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265 

266 

267 

268 

269 

270 

271 

272 

273 

274 

275 

276 

277 

278 

279 

280 
281 
282 

283 

284 

285 

286 
2S7 
288 

289 

290 

291 

292 

293 

294 

295 

296 

297 

298 

299 

300 

301 

302 


THESCSV=THESC-1. 

CALL VEL (U, V, W, PSIOFF,THEOFF, PHIOFF, PSISB,THESB , PHI S3, 

* THESCSV , PHI SC , THESC2 , PHI SC2 , ALPSV, BETSV) 
DALPSV=ALPSV-ALPC 

DBETSV=3ETSV-BETC 

CALL VEL (U, V, V, PSIOFF,THEOFF, PHIOFF, PSISB,THESB , PKISB, 

* TKESC , PHISC,THSSC2, PHISC2, ALP .BET ) 

DALP =ALP - ALPC 

DBET =BET - BETC 

FA=ALP - ALPSV 

FB=BET - BETSV 

FSV = FA*DALPSV + FB*D3ETSV 

F = FA*DAL? + FB*D3ET 

DO 1100 ICTHE=1 , 3 

CALL CONV(THESC ,F, THESCSV, FSV) 

CALL VEL (U, V,W, PS IOFF,THEOFF, PHIOFF, PS ISB,THESB, PHIS B, 

* TKESC , PHISC,THESC2,PHISC2, ALP , BET ) 

DALP =ALP - ALPC 

DBET =BET - BETC 

F = FA*DALP + FB*DBET 
IF(A3S(F) . LT. TOLF) GO TO 1110 
1100 CONTINUE 
1110 CONTINUE 

IF(TKESC.EQ.O.) THESC=. 000001 
PHISCSV=PHISC-1 . 

CALL VEL (U, V,W, PS IOFF,THEOFF, PHIOFF, PSISB.THESB, FHISB, 

* THESC,PHISCSV,THESC2,PHISC2, ALPSV, BETSV) 
DALPS V=ALPSV -ALPC 

DBETSV=BETSV-BETC 

CALL VEL ( U,V,V, PS IOFF, THEOFF, PHIOFF, PS ISB, TKES3, PHISB, 

* THESC, PHISC , THESC2 , PHI SC2 , ALP , BET ) 
DALP=ALP-ALPC 

DBET=BET-BETC 

FA=AL?-ALPSV 

FB=BET-BETSV 

FSV = FA*D ALPSV + FB*DBETSV 
F = FA*DALP + FB*DBET 
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303 

304 

305 

306 

307 

308 

309 

310 

311 

312 

313 

314 

315 

316 

317 

318 

319 

320 

321 
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323 

324 

325 

326 

327 

328 

329 

330 

331 

332 

333 

334 

335 

336 

337 

338 

339 

340 


DO 1200 ICPHI=1, 3 

CALL CONV( PHISC, F,PHISCSV,FSV) 

CALL VEL (U, V, W, PSIOFF,THEOFF, PHIOFF,PSISB,THESB, PHISB, 

* THESC, PHISC ,THESC2,PHISC2, ALP , BET ) 
DALP=ALP-ALPC 

DBET=3ET-BETC 
F = FA*DALP + FB*DBET 
IF(ABS(F) . LT.TOLF) GO TO 1210 
1200 CONTINUE 
1210 CONTINUE 

THESC2S=THESC2-1. . 

CALL VEL (U, V,W,PSIOFF, THEOFF,PHIOFF, PS ISB.THESB, PHISB, 

* THESC, PHISC, THESC2S,PHISC2,ALPSV,BETSV) 
DALPSV=ALPSV-ALPC 

DBETSV=BETSV-BETC 

CALL VEL (U, V,W, PSIOFF,THEOFF,PHIOFF,PSISB,THESB, PHISB, 

* THESC, PHISC, THESC2 ,PHISC2,ALP ,BET ) 
DALP=ALP-ALPC 

DBET=BET-BETC 
FA=ALP -ALPSV 
FB=BET -BETSV 

FSV = FA*D ALPSV + FB*DBETSV 
F * FA*DALP + FB*D3ET 
DO 1300 ICTHE2=1 , 3 
CALL C0NV(THESC2,F,THESC2S,FSV) 

CALL VEL (U,V,W, PSIOFF,THEOFF,PHIOFF,PSI SB, THESB, PHISB, 

* THESC, PHISC, THESC2 ,PHISC2,ALP , BET ) 
DALP=ALP-ALPC 

D3ET=BET-BETC 
F = FA*DALP + FB*DBET 
IF(A3S(F). LT.TOLF) GO TO 1310 
1300 CONTINUE 
1310 CONTINUE 


C CHECK TO SEE IF ALP AND BET ARE WITHIN TOLDAB OF ALPC AND BETC 

IF ( (ABS(DALP)+ABS(DBET)) .LT. TOLDAB ) GO TO 2010 

2000 CONTINUE 
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2010 CONTINUE 


341 

342 

343 

344 
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346 

347 

348 

349 

350 
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352 
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363 

364 

365 
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367 

368 

369 

370 

371 

372 

373 

374 

375 

376 

377 

378 


PRINT 97, ICONV 
PRINT 94 

PRINT 99, THZSC, PHISC, THESC2, PHISC2,ALP, BET 
IF (IREPT.GE.6) GO TO 3020 

C CHECK TO SEE IF THESC CONVERGED OUTSIDE THESC LIMIT 

IF (THESC. LT.THESLL) THEN 
THESC=THESLL 
GO TO 2020 
END IF 

IF (THESC. GT.THESLU) THEN 
THESC=THESLU 
GO TO 2020 
END IF 


C CHECK TO SEE IF CONVERGED OUTSIDE PHIS LIMIT 

IF(PHISC.GT.PHISLU) THEN 
PHISC=PHISC - 180. 

THESC= -THESC 
GO TO 50 
END IF 

IF(PHISC.LT.PHISLL) THEN 
PHISC=PHISC + 180. 

THESC= -THESC 
GO TO 50 
END IF 

C GO TO END 

GO TO 3020 

2020 CONTINUE 

C FINAL CONVERGENCE ON ALPHA COMMAND (ALPC) AND BETA COMMAND (BETC) 

C WITHOUT REGARD TO DISTANCE (DIS), AND WITH THESC SET TO 

C THE LIMITS (THESLL OR THESLU) 


38 



379 

380 

381 

382 
363 

384 

385 

386 

387 

388 

389 

390 

391 

392 

393 

394 

395 

396 

397 

398 

399 

400 

401 

402 

403 

404 

405 

L *3 

L. „ , 

408 

409 

410 

411 

412 

413 

414 

415 

416 


SET TO PREVIOUS ANSWERS LIMITED IN THESC 
PHISC = PHISCL 
THESC2 = THESC2L 

PRINT 93 
PRINT 96 

PRINT 99 , THESC , PHI SC , THESC 2 , PHI SC2 , ALPC , BETC , PSIOFF , THEOFF , 

* PHI OFF 

DO 3000 IC0NV=1 , 100 
THESC2S=THESC2- 1 . 

CALL VEL (U, V, V, PSIOFF, THEOFF, PHIOFF, PSI SB, TKESB,PHISB, 

* THESC, PHISC, THESC2S,PHISC2,ALPSV,EETSV) 
DALPSV=ALPSV-ALPC 

D3ETSV=BETSV-BETC 

CALL VEL (U, V,W, PSIOFF, THEOFF, PHIOFF, PS I SB, THESB.PHISB, 

* THESC, PHISC, THESC2 ,PHISC2,ALP ,BET ) 
DALP=ALP-ALPC 

DBET=BET-BETC 
FA=ALP -ALPSV 
FB=BET -BETSV 

FSV = FA*DALPSV + F3*DBETSV 
F = FA*DALP + FB*DBET 
DO 2300 ICTHE2=1, 3 
CALL CONV(THESC2,F,THESC2S,FSV) 

CALL VEL (U.V.W, PSIOFF, THEOFF, PHIOFF, PSISB, THESB.PHISB, 

* THESC, PHISC, TKESC2 ,PHISC2,ALP ,EET ) 
DALP=ALP-ALPC 

DBET=BET-BETC 
F = FA*DALP + FB*DBET 
IF(ABS(F) . LT.TOLF) GO TO 2310 
2300 CONTINUE 
2310 CONTINUE 

IF(TKESC . EQ. 0 . ) THESC=. 000001 
PHI SCSV=PHI SC-1. 
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418 

419 

420 

421 

422 

423 

424 

425 

426 

427 
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441 
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443 

444 

445 

446 

447 

448 

449 

450 

451 

452 

453 

454 


CALL VEL (U, V, W, PSIOFF,THEOFF, PHIOFF, PSISB.TKESB , PHI SB, 

* THESC, PHISCSV,THESC2, PHISC2, ALPSV, BETSV) 

DALPSV=ALPSV-ALPC 

DBETSV=BETSV-BETC 

CALL VEL (U,V, W, PSIOFF,THEOFF, PHIOFF, PSISB,THESB, PHISB, 

* TKESC, PHISC , THESC2, PHISC2.ALP , BET ) 

DALP=ALP-ALPC 

DBET=BET-BETC 
FA=ALP -ALPSV 
FB=BET-BETSV 

FSV = FA*DAL?SV + FB*DBETSV 
F = FA*DALP + FB*DBET 
DO 2200 ICPKI=1, 3 
CALL CONV(PHISC,F,PHISCSV,FSV) 

CALL VEL (U,V,W,PSIOFF,THEOFF, PHIOFF, PSISB.THESB, PHISB, 

* THESC, PHISC , THESC2 , PHISC2, ALP , BET ) 

DALP=ALP-ALPC 

DBET=BET-BETC 
F = FA*DALP + FB*DBET 
IF(ABS(F) . LT.TOLF) GO TO 2210 
2200 CONTINUE 
2210 CONTINUE 

: CHECK TO SEE IF ALP AND BET ARE WITHIN TOLDAB OF ALPC AND BETC 

IF ( (A3S(DALP)+ABS(DBET)) .LT. TOLDAB ) GO TO 3010 

3000 CONTINUE 
3010 CONTINUE 

PRINT 97, ICONV 
PRINT 94 

PRINT 99, THESC, PHISC, TKESC2, PHISC2,ALP, BET 
IF (IREPT.GE.6) GO TO 3020 

CHECK TO SEE IF CONVERGED OUTSIDE PHIS LIMIT AND SAVE ANSWERS 
WITH PITCH LIMITED TO THESCLL OR THESCLU FOR NEXT COM?UTAT T ON 
IF(PHISC.GT.PHISLU) THEN 
PHISC=PHISC - 180. 
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455 

456 

457 

458 

459 

460 

461 

462 

463 

464 

465 
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467 

468 
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472 
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484 

485 

486 

487 

488 

489 

490 

491 


THESC= -THESC 
PHISCL=PHISC 
THESC2L=TKESC2 
GO TO 50 
END IF 

IF(PHISC.LT.PHISLL) THEN 
PHISC=PHISC + 180. 
THESC= -rriESC 
PHISCL=PHISC 
THESC2L=THESC2 
GO TO 50 
END IF 


C SAVE ANSWERS WITH PITCH LIMITED TO TKESLL OR THESLU 

C FOR NEXT COMPUTATION 


PHISCL=PHISC 
THESC2L=THESC2 
3020 CONTINUE 

CALL DIST(R1 ,X2, X3, PSIOFF,THEOFF, PHICFF, THESC, PHI SC, THESC2 , 
* DY ,DZ ) 

PRINT 98 
PRINT 94 


PRINT 99, THESC, PHISC, 
PRINT 98 
PRINT 98 
STOP 


99 

FORMAT (6F9 

.4, 2F7 . 

3,F10. 5) 

98 

FORMAT ( ) 



97 

FORMAT ( 1H , 

"ICONV 

=”,I3) 

96 

FORMAT (" 

THESC 

PHISC 


* " 

PSIOFF 

THEOFF 

95 

FORMAT (" 

THESC 

PHISC 


* " 

DBET 

DY 

94 

FORMAT(" 

THESC 

PHISC 


* ii 

DY 

DZ") 

93 

FORMAT (6F9 

.4, 14X, 

F10.5) 


END 


THESC2, PHISC2, ALP, BET,DY,DZ 


THESC2 PHISC2 ALPC BETC", 

PH I OFF”) 

THESC2 PHISC2 DALP", 

DZ F") 

THESC2 PHISC2 ALP BET ", 
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SUBROUTINE VEL (U, V.W.PSIOFF.THEOFF.PHIOFF.PSISB.THESBjPHISB 
* THESC,PHISC ) THESC2,PHISC2,ALP,BET) 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


THIS SUBROUTINE CALCULATES THE ANGLE OF ATTACK (ALP) AND ANGLE OF 
SIDESLIP (BET) OF A WIND TUNNEL MODEL. INPUTS ARE VELOCITY COMPONENTS 
IN THE WIND TUNNEL (U, V, AND W) , THE STING OFFSET ANGLES (PS I OFF* TKEOFF 
AND PHIOFF) , THE STING BENDING ANGLES (PSISB, THESB, AND PHISB AND 
THE STING DRIVE ANGLES (THESC, PHISC, THESC2 AND PHISC2) . THE * SUBROUTINE 
CALCULATES THE COMPONENTS OF THE FREE STREAM VELOCITY ALONG THE THREE 
AXES OF THE MODEL AFTER EACH ROTATION. AFTER THE LAST ROTATION THESE 
VELOCITIES ARE USED TO CALCULATE THE ANGLE OF ATTACK (ALP) AND THE 
ANGLE OF SIDESLIP (BET). 


DOR=57. 2957795 

C STING PITCH (Y) 

UB=U*COSD(THESC)-W*SIND(THESC) 

VB=V 

W3=W*COSD(THESC)+U*SIND(THESC) 

C STING ROLL (X) 

UC=UB 

VC=VB*COSD( PHISC) -WB ,V SIND(PHISC) 
WC=WB*COSD(PHISC)+VB*SIND(PHISC) 

C OFFSET YAW (Z) 

UD=UC*COSD( PSIOFF ) -VC*S IND( PS IOFF) 
VD=VC*COSD(PSIOFF)+UC*SIND(PSIOFF) 
WD=WC 

c OFFSET PITCH (Y) 

UE=UD*COSD(THEOFF)-WD*SIND(THEOFF) 

VE=VD 

WE=W T D*COSD(THEOFF ) +UD*SIND ( THEOFF) 
C OFFSET ROLL (X) 

UF=UE 

VF=VE*COSD(PHIOFF)-WE*SIND(PHIOFF) 
WT=WE * C 0 S D ( PH I OFF ) + VE *S I ND ( PH I OFF ) 
C 2ND STING PITCH (Y) 

UG=UF*C0 S D ( THE S C 2 ) -WF*S IND ( THE S C 2 ) 
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VG=VF 

VG=ViT*C0SD(THZSC2)+UF“SIND(THESC2) 

C 2ND STING ROLL (X) 

UH=UG 

VH=VG*COSD( PHISC2 ) -WG*S IND( PHI SC2 ) 
WK=VG*COSD ( PHI SC 2 ) +VG*S I ND ( PH I SC 2 ) 

C STING BENDING IN YAW (Z) 

UI=UH*COSD ( PS I SB ) - VK*S IND( PS I SB) 
VI=VH*COSD(PS I SB ) +UH*SIND ( PS I S3 ) 
WI=VH 

c STING BENDING IN PITCH (Y) 

UJ=UI*COSD(TEESB)-WI*SIND(THESB) 
VJ=VI 

VJ=WI*COSD(THESB)+UI*SIND(TKESB) 

C STING BENDING IN ROLL (X) 

UK=UJ 

VX=VJ*C0SD(PHIS3)-WJ*SIND(PHISB) 
VX=WJ*C0SD(PHIS3)+VJ*SIND(PHISB) 
r AT.pui a\d ■rfTA 

IF( WK. EQ . 0 . * AND . UK . EQ . 0 . ) UK= .0000001 
ALP=AT AN 2 ( VK , ID ) '-'DOR 
IF(VK.tT.-l.)VK*-l. 

IFCVX.GT.l.) VK=1. 

B ET=A S I N ( - VK ) *DOR 

RETURN 

END 
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SUBROUTINE DIST(R1,X2,X3, PSIOFF, THE0FF,PHI0FF,THESC,PHISC,THESC2, 
* DY,DZ) 

C 

C THIS SUBROUTINE CALCULATES THE POSITION OF THE MODEL CENTER 

C WITH RESPECT TO THE TUNNEL AXIS SYSTEM. THE SUBROUTINE STARTS AT 
C THE MODEL AND PROCEEDS TO THE TUNNEL AXIS SYSTEM. THE ROTATIONS 
C AND TRANSLATIONS ARE TAKEN IN REVERSE ORDER FROM THE ORDER USED 
C IN THE MAIN PROGRAM. THE STING BENDING ANGLES ARE IGNORED. 

C THE ORDER OF ROTATIONS ARE: 

C SECOND STING ROLL (PHISC2) , SECOND STING PITCH (THESC2), 

C OFFSET ROLL (PSIOFF), OFFSET PITCH (THEOFF), OFFSET YAW (PSIOFF), 

C STING ROLL (PHISC), AND STING PITCH (THESC) . 

C R1 IS THE RADIUS OF ROTATION OF THE ARC SECTOR. 

C X2 IS THE LENGTH OF THE MAIN STING. 

C X3 IS THE LENGTH OF THE SECOND (ARTICULATED) STING. 

C 

XA=0 . 

YA=0 . 

ZA=0. 

C TRANSLATION (X) HIGH ALPHA STING 

XB=XA - X3 
YB=YA 
ZB=ZA 

C 2ND STING ROLL (X) 

C NO EFFECT ON X, Y OR Z 

C 2ND STING PITCH (Y) 

XC=XB*COSD( -THESC2) -ZB*SIND( -THESC2) 

YC=YB 

ZC=Z3*C0SD( -THZSC2)+XB*SIND( -THESC2) 

C TRANSLATION (X) MAIN STING 

XD=XC - X2 
YD=YC 
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C OFFSET ROLL (X) 

XE=XD 

YE=YD*COSD( -PHIOFF) -ZD*SIND( -PHIOFF) 
ZE=ZD*COSD(-PHIOFF)+YD*SIND( -PHIOFF) 

C OFFSET PITCH (Y) 

XF=XE*COSD( -THEOFF) - ZE*S I ND( -THEOFF) 
YF=YE 

ZF=ZE*COSD( -THEOFF)+XE*SIND( -THEOFF) 

C OFFSET YAW (Z) 

XG=XF*COSD( -PSIOFF) -YF*SIND( -PSIOFF) 
YG=YF*COSD ( -PS I OFF ) +XF*S IND ( - PS I OFF ) 
ZG=ZF 

C TRANSLATION (X) ,ARC SECTOR 

XH=XG + R1 
YH=YG 
ZH=ZG 

C STING ROLL (X) 

XI=XH 

YI=YH*COSD( -PHISC) -ZH*SIND( -PHISC) 
ZI=ZH*COSD( -PHISC)+YH*SIND( -PHISC) 

C STING PITCH (Y) 

XJ=XI*COSD( -THESC) -ZI*SIND( -THESC) 
YJ=YI 

ZJ=ZI*COSD( -THESC)+XI*SIND( -THESC) 

DY=YJ 

DZ=ZJ 

RETURN 

END 
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SUBROUTINE CONV (X, Y,XSAVE, YSAVE) 


1 

2 C 

3 C THIS SUBROUTINE CALCULATES THE VALUE OF X WHICH MINIMIZES THE VALUE OF Y. 

4 C THE CALLING PROGRAM CALCULATES THE VALUES OF Y FOR EACH VALUE OF X. 

5 C THE NEW VALUE OF X IS DETERMINED BY CALCULATING WHERE A STRAIGHT LINE 

6 C THROUGH THE LAST TWO PREVIOUS PAIR OF POINTS, X AND Y, AND XSAV2 AND YSAVE, 

7 C INTERSECT THE X AXIS. THIS NEW VALUE OF X IS RETURNED TO THE CALLING 

8 C PROGRAM IN THE X PARAMETER. 


9 

C 


10 


X1=XSAVE 

11 


Y1=YSAVE 

12 


X2=X 

13 


Y2=Y 

14 


IF(X2 . EQ. XI) GO TO 3 

15 


IF(Y2.EQ.Y1) GO TO 4 

16 


XK=(Y2-Y1)/(X2-X1) 

17 


X=X2-Y2/XK 

18 


XA=(Xl+X2)/2. 

19 


DX=ABS(X2-X1) 

20 


IF(A3S(X-XA).GT.3.5*DX) X=XA+3. 5*SIGN( DX, (X-XA) ) 

21 


GO TO 100 

22 

3 

X=X2-Y2 

23 


GO TO 100 

24 

4 

X=(X2+Xl)/2 . 

25 

100 

XSAVE=X2 

26 


YSAVE=Y2 

27 


IF(ABS(Y1) . LT.ABS(Y2)) THEN 

28 


XSAVE=X1 

29 


YSAVE=Y1 

30 


END IF 

31 


RETURN 

32 


END 
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APPENDIX B 


COMPUTER LISTING OF PROGRAM STNG2PR 


This appendix contains a computer listing of the program STNG2PR which 
calculates the wind tunnel sting pitch and roll angles and second sting pitch angle 
required to obtain a desired angle of attack, a, and sideslip, /?, and to position the 
model in the center of the tunnel for a wind tunnel model with on board accelerometers 
to measure model pitch and/or roll angles . The program accepts accelerometer 
measurements of model pitch and roll, wind tunnel stream flow angles in two directions 
and sting offsets and sting bending angles in three directions 
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PROGRAM STNG2PR ( INPUT, OUTPUT) 

C THIS PROGRAM CALCULATES THE STING ANGLES FOR THE HIGH ALPHA STING SYSTEM 
C TO GET THE DESIRED ALPHA AND BETA AND THE MINIMUM DISTANCE FROM THE 
C CENTERLINE OF THE TUNNEL ( ONLY THE SECOND PITCH ANGLE IS USED, NOT 
C THE SECOND ROLL ANGLE) 

C THE PROGRAM ACCEPTS INPUTS FROM ACCELEROMETERS ON BOARD THE MODEL TO 
C MEASURE THE MODEL PITCH AND ROLL RELATIVE TO GRAVITY 
C 

C ANSWERS SAVED FOR NEXT COMPUTATION 
C 

C THE ORDER OF ROTATIONS ARE : STING PITCH (THESC), STING ROLL (PHISC) 

C OFFSET YAW (PSIOFF), OFFSET PITCH (THEOFF), OFFSET ROLL (PHIOFF) 

C SECOND STING PITCH (THESC2) , SECOND STING ROLL (PHISC2), 

C BENDING IN YAW (PSISB), BENDING IN PITCH (THESB), AND BENDING IN ROLL (Ph'ISB) 
0 

C CODED BY -- JOHN B. PETERSON, JR. NASA/LARC/AAD/KRNAB 1990 

c 


C STING OFFSETS 

PSI0FF=0 . 

THE0FF=-20. 

PHI0FF=0 . 

PHISC2=0. 

C STING 

C 

C R1 IS 

C X2 IS 

C X3 IS 

C 

Rl=122. 5 
X2=87 . 5 
X3=48 . 9 18 

C LIMITS 


LENGTHS (SHOULD BE ON THE ORDER OF 57.3 UNITS SO THAT 
DISTANCES AND ANGLES ARE OF SAME ORDER OF MAGNITUDE) 
THE RADIUS OF ROTATION OF THE ARC SECTOR. 

THE LENGTH OF THE MAIN STING. 

THE LENGTH OF THE SECOND (ARTICULATED) STING. 
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C LIMITS ON STING ROLL ANGLE 

PHISLL=-85 . 

PHISLU=100. 

C FOR INVERTED RUNS USE FOLLOWING LIMITS 
C PHISLL=80. 

C PHISLU=265 . 

C LIMITS ON STING PITCH ANGLE (THESE LIMITS ALSO LIMIT 

C THE AVAILABLE BETA TO +19 & -11 UPRIGHT AND -19 & +11 INVERTED) 

THESLL=-11 . 

THESLU=19. 

C STREAM FLOW ANGLES 

C POSITIVE FOR FLOW FROM BELOW AND FROM RIGHT 

SWA=. 0 
UWA=. 0 

C FREE STREAM VELOCITIES (TOTAL VEL. = 1.0) 

U=SQRT( 1./ (l.+(TAND(SWA))**2+(TAND(UWA))**2 ) ) 

V=-U*TAND(SWA) 

W= U*TAND(UWA) 

C SET INITIAL VALUES FOR VARIABLES 

THESC =0.0 
PHISC =0.0 
THESC2 = 20. 

PHISC2 =0.0 

THESCUL=0 . 0 
PHISCUL=0 . 0 
THES2UL=20. 

PHISCL=0 . 0 
THESC2L=20. 

THESSAV=999 . 

PHISSAV=999 . 

THES2SV=999 . 
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112 


C TOLERANCES 

TOLF=. 00001 
TO LDAB=. 00001 
TOLANG=. 01 

c INPUTS TO CONTROL PROGRAM 

C COMMAND ANGLES 

ALPC=40 . 

BETC=1Q. 


STING DEFLECTIONS 

PSISB=0. 0 
THESB=0. 0 
PHIS3=0. 0 


STING POSITION 
THES=THESC 
PHIS=PHISC 
THES2=THESC2 
PHIS2=PHISC2 


C 

C 

c 

c 

c 


MODEL PITCH AND ROLL (SUBROUTINE SIMUST IS USED HERE 
TO GENERATE VALUES OF MODEL PITCH AND ROLL FOR THIS* PR0GR4M 
ACTUALLY THEY WILL BE MEASURED WITH ACCELEROMETERS ON BOARD 
ME MODEL AND INPUT INTO THE PROGRAM AS STAND 


CALL SIMUST(PSIOFF 
* THES 

THEMOB=THEMOB+0 . 
PHIM0B=PHIM0B+0 . 


,THEOFF , PHIOFF , PSISB,THESB,PHISB , 

» PHIS ,THES2 , PHI S2 , PS IMOB , THEMOB , PH IMOB ) 


END OF INPUTS TO CONTROL PROGRAM 


C 


SET TO PREVIOUS ANSWERS 
THESC = THESCUL 
PHISC = PHISCUL 
THESC2 = THES2UL 


UNLIMITED IN THESC 
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START OF CONTROL PROGRAM 
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132 

133 

134 

135 

136 

137 

138 

139 

140 

141 

142 

143 

144 

145 

146 

147 
1.48 
L49 
150 


C 

C DETERMINE THEORETICAL PITCH AND ROLL OF MODEL 

C AND COMPARE WITH MEASURED PITCH AND ROLL TO GET ERROR 

CALL S IMUST( PS IOFFjTHEOFF, PHIOFF.PS ISB.THESB, PHI SB, 

* THES , PHIS ,THES2 ,PHIS2,PSIMT,THEMT, PHIMT) 

DTHEMO B=THEMO B -THEMT 
DPHIMOB=PHIMOB -PHIMT 


***Vrfr**************************************-fr)V****** ********** 


C IF THEMOB OR PHIMOB IS NOT AVAILABLE, DTHEMOB OR DPHIMOB 
C SHOULD BE SET TO ZERO 
C DTHEM0B=0. 

C DPHIMOB=0. 

*'^***7c********^*rt*rt******-*Vrfc***rt*Y.-*****'fr ****************** 


PRINT 98 
PRINT 92 

PRINT 99 , THEMOB , PHIMOB , DTHEMOB , DPHIMOB 

C SET REPEAT COUNTER TO 0 

IREPT = 0 

C START OVER POINT IF THE PROGRAM CONVERGES OUTSIDE THE 

C THE STING ROLL LIMITS (PHISLL & PHISLU) 

50 CONTINUE 

IREPT * IREPT + 1 

PRINT 98 
PRINT 96 

PRINT 99,THESC, PHISC,THESC2, PHISC2, ALPC, BETC, PSIOFF,THEOFF, 

* PHIOFF 

C CONVERGE ON ALPHA COMMAND (ALPC), BETA COMMAND (BETC), 

C AND DISTANCE (DIS) 
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154 

155 
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160 
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173 

174 

175 

176 

177 

178 

179 

180 
181 
182 

183 

184 
135 
186 

187 

188 


DO 1000 IC0NV=1, 100 

thescsv=thesc-i 

* CALL SIHUST(PSIOFF t THEOFF, PHI0FF,PSISB,THESB,PHrS8 
THENOBT=THEMT+DThI«6b HISC ,THESC2 • PKISC2 .PSIMT,TH£.MT,PHIMT) 
PH I MO 3T=PH I MT+DPH I MOB 

CALL ALPBET( U, V, W, PS IMT, THEMOBT, PHIMOBT ALPSV BFTSV'i 

^CALL DIST gW“,PSI0FF,THF0FF,PHI0FF;THESCSV',PHISC,THESC2, 

DALPSV=ALPSV-ALPC 

DBETSV=BETSV-BETC 

DISSV = DZSV*COSD(PHISC) + DYSV*SINDf PHISC1 

^AIXSiauSTt^IOFF.mOT.PBIOFF.mL^B.PHPSB, 

THEMOBT=THEMT+DTHEMOB C ,THESC2 J pHIS C2,PSIMT J THEMT J PHIMT) 
PH I MO BT=PH I MT+DPH I MOB 

JfJi* ALPBET(U,V,V,PSIMT, THEMOBT, PHIMOBT ALP BET ■> 

* DIST ^Y 1, ^Z X3 ) PSI0FF ' mOFF ’ P H IOFF * TH ESc’ .PHISC.THESC2, 
DALP =ALP -*ALPC 
DBET =BET - BETC 

?I=alp = - D IlpsS 0SD(PHISC) + 

FB=BET - BETSV 
FD=DIS - DISSV 

FSV = FA*DALPSV + FB*DBETSV + FD*DISSV 
F - FA*DALP + FB*DBET + FD*DIS 
DO 100 ICTHE=1,3 
CALL CONV(THESC , F,THESCSV, FSV) 

^CALL SIMUST(P3I0FF,THE0FF, PHIOFF, PSISB.THESB, PHISB , 

THEMCIBT=THEHT+Dt!iEm6b HISC ,TlffiSC2 > PHISC2 - PSIff !'.THEHT,PHIfrO 
PHIMOBT=PHI MT+DPH I MOB 

CALL ALPBET( U, V, W , PSIMT, THEMOBT PHIMOBT ALP BET ^ 

^CALL DISTCR1,X2,X3,PSI0FF,THE0FF, P HI0^;TMSC* B ^PHISC,THESC2, 
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189 

190 

191 

192 

193 

194 

195 

196 

197 

198 

199 

200 
201 
202 

203 

204 

205 

206 

207 

208 

209 

210 
211 
212 

213 

214 

215 

216 

217 

218 

219 

220 
221 
222 

223 

224 

225 

226 


DALP =ALP - ALPC 

DBET =BET - BETC 

DIS = DZ *C0SD(PHISC) + DY *SIND(PHISC) 

F = FA*DALP + FB*DBET + FD*DI5 

IF(ABS(F) . LT.TOLF) GO TO 110 
100 CONTINUE 
110 CONTINUE 

IF (THESC .EQ. 0.) THESC=. 000001 
PHISCSV=PHISC-1. 

C ALL S IMUST( PS I OFF , THE OFF , PH I OFF , PS I SB , THE S B , PHI S B , 

* THESC , PHISCSV,THESC2 ,PHISC2, PS IMT,THEMT, PHIMT) 
THEMOBT=THEMT+DTHEMOB 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U, V, W, PSIMT,THEMOBT, PHIMOBT, ALPSV, BETSV) 

CALL DIST(R1,X2, X3, PSIOFF,THEOFF, PHIOFF, THESC, PHISCSV,TKESC2, 

* DYSV.DZSV) 

DALPSV=ALPSV-ALPC 

DBETSV=BETSV-BETC 

DISSV = DZSV*COSD(PHISCSV) + DYSV*SIND(PHISCSV) 

CALL SIMUST(PSIOFF,THEOFF, PHIOFF, PSISB,THES8, PHISB, 

* THESC , PHISC ,THESC2 , PHISC2.PS IMT,THEMT, PHIMT) 
THEMOBT=THEMT+DTHEMOB 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET( U, V , W, PS IMT, THEMOBT, PHIMOBT, ALP , BET ) 

CALL DIST(R1,X2,X3, PS IOFF,THEOFF, PHIOFF, THESC, PHISC ,THESC2, 

* DY ,DZ ) 

DALP=ALP-ALPC 

DBET=BET-BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

FA=ALP-ALPSV 
FB=BET-BETSV 
FD=DIS - DISSV 

FSV = FA*DALPSV + FB*DBETSV + FD*DISSV 
F = FA*DALP + FB*DBET + FD*DIS 

DO 200 ICPHI=1, 3 
CALL CONV(PHISC, F, PHISCSV, FSV) 

CALL SIMUST(PSIOFF,THEOFF, PHIOFF, PSISB,THESB, PHISB, 

* THESC , PHISC ,THESC2 ,PHISC2,PSIMT, THE MT, PHIMT) 
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227 

228 

229 

230 

231 

232 

233 

234 

235 

236 

237 

238 

239 

240 

241 

242 

243 

244 

245 

246 

247 

248 

249 

250 

251 

252 

253 

254 

255 

256 

257 

258 

259 

260 
261 
262 

263 

264 


THEM0BT=THEMT+DTHEM0B 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U, V,W, PSIMT.THEMOBT, PHIMOBT, ALP ,BET ) 

CALL DIST(R1, X2,X3 , PSIOFF , THEOFF, PHIOFF, THESC, PHI SC .THESC2, 

* DY ,DZ ) 

DALP=ALP-ALPC 

DBET=BET-BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

F = FA*DALP + FB*DBET + FD*DIS 
IF(ABS(F) . LT.TOLF) GO TO 210 
200 CONTINUE 
210 CONTINUE 

THESC2S=THESC2-1. 

CALL SIMUST( PSIOFF, THEOFF, PHIOFF, PSISB,THESB, PHISB, 

* THESC .PHISC ,THESC2S, PHISC2, PSIMT,THEMT, PKIMT) 
THEMOBT=THEMT+DTHEMOB 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U, V,W, PSIMT.THEMOBT, PHIMOBT, ALPSV, BETSV) 

CALL DIST(R1,X2,X3, PSIOFF, THEOFF, PHIOFF, THESC, PHISC, THESC2S, 

* DYSV, DZSV) 

DALPSV=ALPSV-ALPC 

DBETSV=BETSV-BETC 

DISSV = DZSV*COSD(PHISC) + DYSV*SIND( PHISC) 

CALL S I MUST ( PSIOFF , THEOFF , PHIOFF , PS ISB , THESB , PHI SB , 

* THESC .PHISC .THESC2 ,PKISC2,PSIMT,THEMT,PHIMT) 
THEMOBT=THEMT+DTHEMOB 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBST(U,V,W, PSIMT.THEMOBT, PHIMOBT, ALP ,BET ) 

CALL DIST(R1,X2,X3, PSIOFF, THEOFF, PHIOFF.THESC, PHISC, THESC2 , 

* DY ,DZ ) 

DALP=ALP-ALPC 

DBET=BET-BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

F A=ALP -ALPSV 
FB=BET -BETSV 
FD=DIS - DISSV 

FSV = FA*DALPSV + FB*DBETSV + FD*DISSV 
F = FA*DALP + FB*DBET + FD*DIS 
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265 

266 

267 

268 

269 

270 

271 

272 

273 

274 

275 

276 

277 

278 

279 

280 
281 
282 

283 

284 

285 

286 

287 

288 

289 

290 

291 

292 

293 

294 

295 

296 

297 

298 

299 

300 

301 

302 


DO 300 ICTHE2=1, 3 

CALL CONV(THESC2,F,THESC2S,FSV) 

CALL S IMUST( PS IOFF , THEOFF , PKIOFF , PSISB , THESB , PHISB , 

* THESC , PHISC ,THE3C2 , PKISC2, PSIMT.THEMT, PHIMT) 
THEM03T=THEMT+DTHEM0 B 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPSET(U, V, V, PSIMT,THEMOBT, PHIMOBT, ALP , BET ) 

CALL DIST(R1,X2,X3, PS IOFF,THEOFF,PHIOFF, THESC, PHISC, THESC2 , 

* DY , DZ ) 

DAL?=ALP-ALPC 

DBET=BET-BETC 

DIS = DZ *COSD(PHISC) + DY *SIND(PHISC) 

F = FA*DALP + FB*DBET + FD*DIS 
IF(ABS(F) .LT.TOLF) GO TO 310 
300 CONTINUE 
310 CONTINUE 

C CHECK TO SEE IF MOVEMENT IN THESC, PHISC AND THESC2 IS LESS THAN 

C TOLANG IN LAST ITERATION 

IF ( AB S( THESC -THE SSAV) . LT. TOLANG 

* . AND. ABS (PHI SC-PHI SSAV) . LT. TOLANG 

* . AND. ABS(THESC2-THES2SV) .LT. TOLANG) GO TO 1010 
THESSAV=TKESC 

PHISSAV=PHISC 
THES2SV=THESC2 
1000 CONTINUE 
1010 CONTINUE 

IF (IREPT.GE. 12) GO TO 3020 

PRINT 97, ICONV 
PRINT 94 

PRINT 99, THESC, PHISC, THESC2, PHISC2,ALP, BET,DY,DZ 

C CHECK TO SEE IF CONVERGED OUTSIDE PHIS LIMIT 

IF(PHISC.GT.PHISLU) THEN 
PHISC=PHISC-180 . 

THESC=-THESC 


55 



303 

304 

305 
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310 
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316 
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333 
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335 

336 
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340 


GO TO 50 
END IF 

IF(PHISC.LT.PHISLL) THEN 
PHISC=PHISC+180. 
THESC=-THESC 
GO TO 50 
END IF 


C 


SAVE ANSWERS UNLIMITED IN PITCH 
THESCUL=TKESC 
PHISCUL=PHISC 
THES2UL=THESC2 


FOR NEXT COMPUTATION 


CHECK TO SEE IF THESC CONVERGED OUTSIDE TKESC LIMIT 

IF (THESC. LT.TKESLL) THEN 
THESC=THESLL 
GO TO 2020 
END IF 

IF (THESC. GT.THESLU) THEN 
THESC=THESLU 
GO TO 2020 
END IF 


C 

C 


PRINT 98 
PRINT 96 


PRINT 9 9, THESC, PHISC,THESC2, PHISC2, ALPC, BETC, PSIOFF,THEOFF, 
PHIOFF 9 


FINAL CONVERGENCE ON ALPHA COMMAND 
WITHOUT REGARD TO DISTANCE (DIS) 


(ALPC) AND BETA COMMAND (BETC) 


DO 2000 IC0NV=1, 100 


THESCS V=THESC - 1 . 

CALL SIMUST(PSIOFF, THEOFF, PHIOFF, PSISB,THESB,PHISB 

THESCSV, PHISC ,THESC2 , PHISC2,PSIMT,THEMT, PHIMT) 
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341 

342 

343 

344 

345 

346 

347 

348 

349 

350 

351 
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357 

358 
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364 

365 
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369 

370 

371 

372 

373 

374 

375 

376 

377 

378 


THEM0BT=THEMT+DTHEM0B 

PHIM0BT=PHIMT+DPHIM0B 

CALL ALPBET(U, V, W, PSIMT,THEM0BT, PHIMOBT, ALPSV , BETSV) 


DALPSV=ALPSV-ALPC 

DBETSV=BETSV-3ETC 

CALL S IMUST( PS IOFF, THEOFF, PHIOFF.PS IS3,THESB, PHIS3, 

* THESC , PHISC ,THESC2 ,PHISC2,PSIMT,THEMT,PHIMT) 

THEMOBT=THEMT+DTHEMOB 
PHIMOBT=PHIMT+DPHIMOB 

CALL ALP3ET(U,V,W, PS IMT.THEMOBT, PHIMOBT, ALP , BET ) 

DALP =ALP - ALPC 
DBET =BET - BETC 
FA=ALP - ALPSV 


FB=BET - BETSV 

FSV = FA*DALPSV + FB*DBETSV 

F = FA*DALP + FB*DBET 

DO 1100 ICTHE=1, 3 

CALL CONV(THESC ,F,THESCSV,FSV) 

CALL SIMUST(PSIOFF,THEOFF , PHIOFF ,PSISB,THESB, PHISB, 
r THESC .PHISC .THESC2 ,PHISC2,PSIMT,THEMT,PHIMT) 


THEMO BT=THEMT +DTHE MOB 
PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U,V,W,PSIMT,THEMOBT, PHIMOBT, ALP , BET ) 

DALP =ALP - ALPC 
DBET =BET - BETC 
F = FA*DALP + FB*DBET 
IF(ABS(F) . LT.TOLF) GO TO 1110 
1100 CONTINUE 
1110 CONTINUE 

IF(THESC.EQ.O. ) THESC=. 000001 
PHISCSV=PHISC-1. 

CALL SIMUST(PSIOFF,THEOFF, PHIOFF, PSISB.THESB, PHISB, 

* THESC ,PHISCSV,THESC2 ,PHISC2,PSIMT,THEMT,PHIMT) 


THEMO BT=THEMT+DTHEM03 
PHIM03T=PHIMT+DPHIM0B 

CALL ALP3ET(U,V,W,PSIMT,THEM03T, PHIMOBT, ALPSV, BETSV) 

DALPSV=ALPSV-AL?C 

DBETSV=BETSV-BETC 


57 


379 
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416 


CALL S IMUST( PS IOFF,THEOFF, PHIOFF, PSISB.THESB, PHISB, 

THESC , PHISC ,Tkc,SC2 , PHISC2, PSIMT THEMT PKTMT"! 
THE MO BT=THE MT+DTKE MOB ^rairu, ittMU.PHIMT) 

PHIMOBT=PHIMT+DPKIMOB 

CALL ALPBET(U,V,W, PSIMT, THEMOBT, PHIMOBT, ALP BET 1 

DALP=ALP - ALPC ‘ J 

DBET=BET-BETC 

FA=ALP-ALPSV 

FB=BET-BETSV 

FSV = FA*DALPSV + FB*DBETSV 
F = FA*DAL? + FB*DBET 
DO 1200 ICPHI=1 , 3 
CALL CONV( PHISC, F, PHISCSV, FSV) 

CALL SIMUST(PSIOFF ,THE0FF , PHIOFF, PSIS8,THESB, PHISB 

THESC , PHISC ,THESC2 , PHI SC 2, PSIMT, THEMT PHIMTl 
THEMOBT=THEMT+DTHEMOB , inr.m , rtum ; 

PHIM03T=PHIMT+DPHIM03 

CALL ALPBET(U,V,W,PSIMT,THEMOBT, PHIMOBT, ALP ,BET ) 
DALP=ALP-ALPC * } 

DBET=BET-BETC 
F = FA*DALP + FB*D3ET 
IF(ABS(F) . LT.TOLF) GO TO 1210 
1200 CONTINUE 
1210 CONTINUE 

THESC2S=THESC2-1. 

CALL SIMUST(PSIOFF,THEOFF, PHIOFF, PSISB,THESB, PHISB, 

THESC , PHISC ,THESC2S,PHISC2, PSIMT THEMT PHTMT"* 
THEMOBT=THEMT+DTHEMOB ’ ’ ^^PHIMT) 

PHIMOBT=PHIMT+DPHIMOB 

DALPS V=ALPS V- ALPC ’ ?S ^ THEM0BT » PHIMOBT, ALPSV, BETSV) 
DBETSV=3ETSV-BETC 

CALL S IMUST( PS IOFF , THEOFF, PHIOFF , PSISB , THESB , PHISB 

THESC , PHISC ,THESC2 ,PKISC2, PSIMT THEMT PHIMT^ 
THEMOBT=THEMT+DTHEMOB , ini.ru , PHIMTj 

PHIMOBT=PHIMT+DPHIMOB 


CALL ALPBET(U,V,W, PSIMT, THEMOBT, PHIMOBT, ALP BET 1 
DALP=ALP -ALPC * } 
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418 
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425 
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DBET=BET-BETC 
FA=ALP -ALPSV 
FB=BET -BETSV 

FSV = FA*DALPSV + FB*DBETSV 

F = FA*DALP + FB*DBET 

DO 1300 ICTHE2=1 , 3 
CALL C0NV(THESC2, F,THESC2S, FSV) 

CALL SIMUST(PSIOFF,THEOFF, PHIOFF, PSISB,THES8, PHISB, 

* THESC , PHISC ,THESC2 , PHISC2, PSIMT,THEMT, PHIMT) 

THEMOBT=THEMT+DTHEMOB 
PHIM0BT=PHIMT+DPHIM03 

CALL ALP9ET(U, V, W, PSIMT,THEMOBT, PHIMOBT, ALP , BET ) 
DALP=ALP-ALPC 
DBET=BET-BETC 
F = FA*DALP + FB*DBET 

IF(ABS(F) . LT. TOLF) GO TO 1310 
1300 CONTINUE 
1310 CONTINUE 


C CHECK TO SEE IF ALP AND BET ARE WITHIN TOLD A3 OF ALPC AND BETC 

IF ( (ABS(DALP)+ABS(DBET) ) .LT. TOLDAB ) GO TO 2010 

2000 CONTINUE 
2010 CONTINUE 

IF (IREPT.GE.6) GO TO 3020 

PRINT 97, ICONV 
PRINT 94 

PRINT 99, THESC, PHISC, THESC2, PHISC2,ALP, BET 

C CHECK TO SEE IF THESC CONVERGED OUTSIDE THESC LIMIT 

IF (THESC. LT.THESLL) THEN 
THESC=THESLL 
GO TO 2020 
END IF 

IF (THESC. GT.THESLU) THEN 
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455 

456 

457 

458 
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46 1 
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474 
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479 
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481 
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485 
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487 
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492 


THESC=THESLU 
GO TO 2020 
ENT) IF 


C CHECK TO SEE IF CONVERGED OUTSIDE PHIS LIMIT 

IF(PHISC.GT.PHISLU) THEN 
PHISC=PHISC - 180. 

THESC= -TKESC 
GO TO 50 
END IF 

IF(PHISC.LT.PHISLL) THEN 
PHISC=PHISC + 180. 

THESC= -THESC 
GO TO 50 
END IF 

C GO TO END 

GO TO 3020 

2020 CONTINUE 

C FINAL CONVERGENCE ON ALPHA COMMAND (ALPC) AND BETA COMMAND (BETC) 

C WITHOUT REGARD TO DISTANCE (DIS), AND WITH THESC SET TO 

C THE LIMIT (THESLL OR THESLU) 

C SET TO PREVIOUS ANSWERS LIMITED IN THESC 

PHISC = PHISCL 
THESC2 = THESC2L 

PRINT 98 
PRINT 96 

PRINT 99, THESC, PHISC, THESC2, PHISC2, ALPC, BETC, PSIOFF.THEOFF, 

* PHIOFF 

DO 3000 ICONV=l, 100 
THESC2S=THESC2-1. 

CALL SIMUST( PSIOFF.THEOFF, PHIOFF, PSISB,THESB,PHISB, 

* THESC .PHISC .THESC2S, PHISC2, PSIMT.THEMT, PHIMT) 
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493 

494 
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501 
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THEMO BT=THEMT+DTHEMO B 
PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U,V,W, PSIMT,THEM03T, PHIMOBT, ALPSV, BETSV) 

DALPSV=ALPSV-ALPC 

DBETSV=BETSV-BETC 

CALL SIMUST(PSIOFF,THEOFF, PHI0FF,PSIS3,THESB, PHISB, 

* THESC , PHISC .THESC2 ,PHISC2,PSIMT,THEMT,PHIMT) 
THEMOBT=THEMT+DTHEMOB 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U, V, W, PSIMT,THEMOBT, PHIMOBT, ALP , BET ) 

DALP=ALP-ALPC 

DBET=3ET-BETC 

FA=ALP -ALPSV 

FB=BET -BETSV 

FSV = FA*DALPSV + FB*DBETSV 

F = FA*DALP + FB*DBET 

DO 2300 ICTHE2=1, 3 
CALL C0NV(THESC2, F.THESC2S , FSV) 

CALL SIMUST(PSIOFF,THEOFF, PHIOFF, PSISB,THESB , PHISB, 

* THESC , PHISC ,THESC2 ,PHISC2,PSIMT,THEMT,PHIMT) 
THEMOBT=THEMT+DTHEMOB 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U, V,W, PS IMT.THEMOBT, PHIMOBT, ALP .BET ) 
DALP=ALP-ALPC 
DBET=BET-BETC 
F = FA*DALP + FB*DBET 

IF(ABS(F) . LT.TOLF) GO TO 2310 
2300 CONTINUE 
2310 CONTINUE 

IFCTHESC.EQ.O. ) THESC=. 000001 
PHISCSV=PHISC-1 . 

CALL SIMUST(PSIOFF,THEOFF,PHIOFF,PSISB,THESB, PHISB, 

* THESC , PHISCSV.THESC2 , PHISC2, PSIMT.THEMT, PHIMT) 

THEMOBT=THEMT+DTHEMOB 

PHIMOBT=PHIMT+DPHIMOB 

CALL ALPBET(U,V,W,PSIMT,THEMOBT, PHIMOBT, ALPSV, BETSV) 
DALPSV=ALPSV-ALPC 
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531 

532 

533 
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536 
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543 
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DBETSV=BETSV-BETC 


CALL S IMUST ( PS IOFF , THEOFF 
* THESC , PHISC 

THEMOBT=THEMT+DTHEMOB 
PHIMOBT=PHIMT+DPHIMOB 


, PHIOFF, PSISB.THESB, PHIS3, 

,THESC2 , PHISC2, PSIMT,THEMT, PHIMT) 


CALL ALPBET( U, V, W, PS IMT, THEMOBT , PHIMOBT, ALP .BET ) 
DALP=ALP - ALPC 


DBET=3ET-BETC 


FA=ALP-ALPSV 

FB=BET-BETSV 


FSV = FA*DALPSV + FB*DBETSV 
F = FA*DALP + FB*DBET 


DO 2200 ICPHI=1, 3 

CALL CONV( PHISC, F, PHISCSV, FSV) 

CALL S IMUST( PS IOFF, THEOFF, PHIOFF, PSISB , THESB , PHISB , 

* T>Wrt THESC ’ PHISC .THESC2 , PHISC2, PSIMT,THEMT, PHIMT) 

THEMOBT=TKEMT+DTHEMOB J 

PHIMOBT=PHIMT+DPHIMOB 


CALL ALPBET( U, V, W, PS IMT , THEMOBT, PHIMOBT, ALP ,BET ) 

DALP=ALP -ALPC 

DBET=BET-BETC 


F = FA*DALP + FB*DBET 
IF(ABS(F) . LT.TOLF) GO TO 2210 
2200 CONTINUE 
2210 CONTINUE 

C CHECK TO SEE IF ALP AND 

IF ( ( ABS ( DALP)+ABS ( DBET) ) .LT. 


BET ARE WITHIN TOLDAB OF ALPC AND BETC 
TOLDAB ) GO TO 3010 


3000 CONTINUE 
3010 CONTINUE 


IF (IREPT.GE.6) GO TO 3020 

PRINT 97, ICONV 
PRINT 94 

PRINT 99, THESC, PHISC, THESC2, PHISC2,ALP, BET 

CHECK TO SEE IF CONVERGED OUTSIDE PHIS LIMIT AND SAVE ANSWERS 
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569 

570 
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581 
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C WITH PITCH LIMITED TO THESCLL OR THESCLU FOR NEXT COMPUTATION 

IF(PHISC.GT.PHISLU) THEN 
PHISC=PHISC - 180. 

THESC= -THESC 
PHISCL=PHISC 
THESC2L=THESC2 
GO TO 50 
END IF 

IF(PHISC.LT.PHISLL) THEN 
PHISC=PHISC + 180. 

THESC= -THESC 
PHISCL=PHISC 
THESC 2L=THESC2 
GO TO 50 
END IF 

C SAVE ANSWERS WITH PITCH LIMITED TO THESLL OR THESLU 

C FOR NEXT COMPUTATION 

PHISCL=PHISC 
THESC2L=THESC2 
3020 CONTINUE 

CALL DIST(R1,X2,X3,PSI0FF,THE0FF,PHI0FF, THESC, PHISC, THESC2 , 

* DY ,DZ ) 

PRINT 98 
PRINT 94 



PRINT 

99, THESC 

, PHISC, 

THESC2, PHISC2, ALP, 

BET,DY,DZ 


PRINT 

98 






PRINT 

98 






STOP 






99 

FORMAT (6F9.4.2F7. 

3.F10.5) 




98 

FORMAT ( 

) 





97 

FORMATC 1H , "ICONV 

=",I3) 




96 

FORMATC" 

THESC 

PHISC 

THE SC 2 

PHISC 2 

ALPC BETC" , 


* " 

PSIOFF 

THEOFF 

PHIOFF") 



95 

FORMATC" 

THESC 

PHISC 

THESC2 

PHISC2 

DALP", 


* " 

DBET 

DY 

DZ 

F") 


94 

FORMATC" 

THESC 

PHISC 

THESC2 

PHISC2 

ALP EET " , 


* " 

DY 

DZ") 
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607 

608 
609 


93 FORMAT (6F9.4, 14X,F10. 5) 

92 FORMAT (" THEMOB PHIMOB DTHEMOB DPHIMOB") 
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1 

2 

3 

4 

5 

6 

7 

8 
9 


SUBROUTINE SIMUST (PSIOFF, THEOFF, PHIOFF, PSISB,THESB,PHISB, 

* THES,PHIS,THES2,PHIS2,PSIMT,THEMT, PKIMT) 

C THIS SUBROUTINE SIMULATES THE STING. IT CALCULATES THE THEORETICAL MODEL 
C YAW, PITCH AND ROLL GIVEN INPUTS OF THE STING OFFSETS, STING BENDING, 

C STING ROLL AND PITCH, AND SECOND STING ROLL AND PITCH 
DOR=57. 2957795 

CALL COMP ( 1 . , 0 . , 0 . ,PSIOFF,THEOFF,PHIOFF,PSISB,THESB,PHISB, 


10 


* THES,PHIS,THES2,PHIS2,XX, YX,ZX) 

11 


CALL COMP ( 0 . , 1 . , 0 . , PS IOFF , THEOFF, PHIOFF , 

12 


* THES,PHIS,THES2,PHIS2,XY,YY,ZY) 

13 


CALL COMP ( 0 . , 0 . , 1. .PSIOFF, THEOFF, PHIOFF, 

14 


* THES,PHIS,THES2,PHIS2,XZ, YZ, ZZ) 

15 



16 



17 

C 

CALCULATE PITCH OF MODEL 

18 


IF(XZ.LT. -1. )XZ=-1. 

19 


IFCXZ.GT. l.)XZ= 1. 

20 


THEMT=AS IN( -XZ ) *DOR 

21 



22 

C 

ROLL AND YAW OF THE MODEL 

23 


IFCYZ.EQ.O. .AND.ZZ.EQ.O. ) THEN 

24 

c 

CASE WHERE PITCH OF MODEL IS +/-90 

25 


PHIMT=ATAN2C -YX, ZX)*DOR 

26 


PSIMT=0 . 

27 


ELSE 

28 


PHIMT=ATAN2C -YZ, ZZ)*DOR 

29 


PS IMT=ATAN2 C -XY , XX) *DOR 

30 


END IF 

31 


RETURN 

32 


END 
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1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 


C 

C 

c 

c 

c 


c 


c 


c 


c 


c 


c 


c 


SUBROUTINE COM? 


(X,Y,Z,PSIOFF,THEOFF,PHIOFF, PSISB .TKESB P^ISB 
THES,PHIS,THES2,PHIS2,XX j YK,ZK) 


2S 


STING PITCH (Y) 
XB=X*COSD(THES) -Z*SIND(THES) 

YB=Y 

ZB=Z*COSD(THES)+X*SIND(THES) 

STING ROLL (X) 

XC=XB 

YC=YB*COSD(PHIS)-ZB*SIND(PHIS) 
ZC-ZB*C0S0(PHIS)+YB*SIND(PHI5) 
OFFSET YAW (Z) 

XD=XC*COSD ( PS IOFF ) - YC*SIND( PS IOFF) 
YD-YC*COSD(PSIOFF)+XC*SIND(PSIOFF) 

ZD— ZC 

OFFSET PITCH (Y) 

XE=XD*COSD(THEOFF)-ZD*SIND(THEOFn 

YE=YD 

ZE=ZD*COSD( THEOFF) +XD*S IND ( THEOFF) 
OFFSET ROLL (X) 

XF=XE 

YF=YE*COSD( PHIOFF) -ZE*SIND(PHIOFF) 
ZF=ZE*COSD(PHIOFF)+YE*SIND(PHIC^F) 

SECOND STING PITCH (Y) 
XG-XF*COSD(THES2) -ZF*SIND(THES2) 
YG=YF 

ZG=ZF*CQSD(THES2)+XF*SIND(THES2) 

SECOND STING ROLL (X) 

XH=XG 

YH=Y G*COSD ( PHI S 2 ) - ZG*S IND ( PHI S 2 ) 
ZH-ZG*COSD(PHIS2)+YG*SIND( PHIS2) 
STING BENDING IN YAW (Z) 
XI-XH*COSD( PS ISB)-YH*SIND( PSISB) 
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37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 


YI=YH*COSD(PSISB)+XH*SIND(PSISB) 

ZI=ZH 

C STING BENDING IN PITCH (Y) 

XJ=XI*C0SD(THESB)-ZI*SIND(TKES3) 
YJ=YI 

ZJ=ZI*COSD(THESB)+XI*SIND(THESB) 

C STING BENDING IN ROLL (X) 

XK=XJ 

YK=YJ*COSD(PHISB) -ZJ*SIND(PHISB) 

ZK=ZJ*COSD(PHISB)+YJ*SIND(PHISB) 

RETURN 

END 
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1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 


SUBROUTINE ALPBET( U,V,W,PSIM, THEM, PHIM, ALP, BET) 

THIS SUBROUTINE CALCULATES THE ANGLE OF ATTACK (ALP) AND 
ANGLE OF SIDESLIP (BET) OF A WIND TUNNEL MODEL. THE INPUTS ARE 
THE VELOCITY COMPONENTS IN THE WIND TUNNEL (U, V, AND W) AND THE 
MODEL EULER ROTATION ANGLES, YAW (PSIM), PITCH (THEM) AND ROLL (PHIM) 

THE SUBROUTINE CALCULATES THE COMPONENTS OF THE FREE STREAM VELOCITY 
ALONG THE THREE AXES OF THE MODEL AFTER EACH ROTATION AND THESE VELOCITY 
COMPONENTS ARE USED TO CALCULATE THE ANGLE OF ATTACK AND ANGLE OF SIDESLIP. 


DOR=57. 2957795 

C YAW (Z) 

UA=U *COSD(PSIM) -V *SIND(PSIM) 

VA=V *COSD(PSIM)+U *SIND(PSIM) 

WA=W 

C PITCH (Y) 

UB=UA*COSD(THEM) -WA*SIND(THEM) 
VB=VA 

WB=W A ,v CO S D ( THEM ) +UA* S I ND ( THEM ) 
C ROLL (X) 

UC=UB 

VC=VB*COSD(PHIM) -WB*SIND(PHIM) 
WC=WB*COSD( PHIM) +V3*SIND( PHIM) 
C ALPHA AND BETA 

IF(WC.NE.O. .AND.UC.NE.O.) THEN 
ALP=ATAN2 ( WC , UC ) *DOR 
ELSE 
ALP=0 . 

END IF 

IF( VC . LT . - 1 . ) VC=- 1 . 

IF(VC.GT. l.)VC= 1. 

BET=ASIN(-VC)*DOR 

RETURN 

END 
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1 SUBROUTINE DIST(R1,X2 J X3,PSI0FF,THE0FF,PHI0FF,TKESC J PHISC,THSSC2, 

2 * DY,DZ) 

3 


4 

C 

THIS SUBROUTINE CALCULATES THE POSITION OF THE MODEL CENTER 

5 

C 

WITH RESPECT TO THE TUNNEL AXIS SYSTEM. THE SUBROUTINE STARTS AT 

6 

C 

THE MODEL AND PROCEEDS TO THE TUNNEL AXIS SYSTEM. THE ROTATIONS 

7 

C 

AND TRANSLATIONS ARE TAKEN IN REVERSE ORDER FROM THE ORDER USED 

8 

C 

IN THE MAIN PROGRAM. THE STING BENDING ANGLES ARE IGNORED. 

9 

C 

THE ORDER OF ROTATIONS ARE: 

10 

C 

SECOND STING ROLL (PHISC2) , SECOND STING PITCH (THESC2) , 

11 

C 

OFFSET ROLL (PSIOFF), OFFSET PITCH (THEOFF), OFFSET YAW (PSIOFF), 

12 

C 

STING ROLL (PHISC), AND STING PITCH (THESC) . 

13 

C 

R1 IS THE RADIUS OF ROTATION OF THE ARC SECTOR. 

14 

C 

X2 IS THE LENGTH OF THE MAIN STING. 

15 

C 

X3 IS THE LENGTH OF THE SECOND (ARTICULATED) STING. 

16 

C 


17 


XA=0 . 

18 


YA=0 . 

19 


ZA=0. 

20 



21 

C 

TRANSLATION (X) HIGH ALPHA STING 

22 


XB=XA - X3 

23 


YB=YA 

24 


ZB=ZA 

25 



26 

C 

2ND STING ROLL (X) 

27 

C 

NO EFFECT ON X, Y OR Z 

28 



29 

C 

2ND STING PITCH (Y) 

30 


XC=XB*COSD( -THESC2) -ZB*SIND( -THESC2) 

31 


YC=YB 

32 


ZC=ZB*COSD( -THESC2)+XB*SIND( -THESC2) 

33 



34 

C 

TRANSLATION (X) MAIN STING 

35 


XD=XC - X2 

36 


YD=YC 
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ZD=ZC 


37 

33 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 
61 
62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 


C OFFSET ROLL (X) 

XE=XD 

YE=YD*COSD( -PHIOFF) -ZD*SIND( -PHIOFF) 
ZE=ZD*COSD( -PHIOFF)+YD*SIND( -PHIOFF) 

C OFFSET PITCH (Y) 

XF=XE*COSD( -THEOFF) -ZE*SIND( -THEOFF) 
YF=YE 

ZF=ZE*COSD( -THEOFF)+XE*SIND( -THEOFF) 

C OFFSET YAW (Z) 

XG=XF*COSD( -PSIOFF) -YF*SIND( -PSIOFF) 
YG=YF*COSD( -PSIOFF)+XF*SIND( -PSIOFF) 
ZG=ZF 

C TRANSLATION (X) .ARC SECTOR 

XH=XG + R1 
YH=YG 
ZH=ZG 

C STING ROLL (X) 

XI=XH 

YI=YH*COSD( -PHISC) -ZH*SIND( -PHISC) 
ZI=ZH*COSD(-PHISC)+YH*SIND( -PHISC) 

C STING PITCH (Y) 

XJ=XI*COSD( -THESC) -ZI*SIND( -THESC) 
YJ=YI 

Z J=ZI*COSD( -THESC)+XI*SIND( -THESC) 

DY=YJ 

DZ=ZJ 


RETURN 

END 
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1 

2 

3 

4 

5 

6 

7 

8 


C 

C 

C 

C 

C 

C 

C 


SUBROUTINE CONV (X.Y.XSAVE, YSAVS) 

THIS SUBROUTINE CALCULATES THE VALUE OF X WHICH MINIMIZES THE VALUE OF Y. 
THE CALLING PROGRAM CALCULATES THE VALUES OF Y FOR EACH VALUE OF X. 

THE NEW VALUE OF X IS DETERMINED BY CALCULATING WHERE A STRAIGHT LINE 
THROUGH THE LAST TWO PREVIOUS PAIR OF POINTS, X AND Y, AND XSAVE AND YSAVE, 
INTERSECT THE X AXIS. THIS NEW VALUE OF X IS RETURNED TO THE CALLING 
PROGRAM IN THE X PARAMETER. 


9 

C 


10 


X1=XSAVE 

11 


Y1=YSAVE 

12 


X2=X 

13 


Y2=Y 

14 


IF(X2.EQ.X1) GO TO 3 

15 


IF(Y2.EQ.Y1) GO TO 4 

16 


XK=(Y2-Y1) /(X2-X1) 

17 


X=X2-Y2/XX 

18 


XA=(Xl+X2)/2. 

19 


DX=ABS(X2-X1) 

20 


IF(ABS(X-XA) . GT. 3 . 5*DX) 

21 


GO TO 100 

22 

3 

X=X2-Y2 

23 


GO TO 100 

24 

4 

X=(X2+Xl)/2. 

25 

100 

XSAVE=X2 

26 


YSAVE =Y2 

27 


IF(ABS(Y1).LT.ABS(Y2)) 

28 


XSAVE=X1 

29 


YSAVE=Y1 

30 


END IF 

31 


RETURN 

32 


END 
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Figure 2. - High angle of attack articulated sting mechanism 
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